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本 书 不 但 介绍 了 精密 运动 控制 的 基本 原理 ， 而 且 就 实现 精密 运动 控制 的 各 环节 进行 了 详 
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原理 ， 为 了 得 到 精确 的 测量 结果 ， 还 专门 介绍 了 机 械 控制 系统 的 稳定 性 和 静 定 问题 ， 以 及 现 
场 总 线 通信 技术 问题 。 
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译 从 序言 


一 、 制 造 技 术 长 盛 永恒 

先进 制造 技术 是 20 世纪 80 年 代 提 出 的 ， 由 机 械 制造 技术 发 展 而 来 。 通 常 可 
以 认为 它 是 将 机 械 、 电 子 、 信 息 、 材 料 、 能 源 和 管理 等 方面 的 技术 ,进行 交叉 、 
融合 和 和 集成， 综合 应 用 于 产品 全 生命 周期 的 制造 全 过 程 ， 包 括 市 场 需求 、 产 品 设 
计 、 工 艺 设计 、 加 工装 配 、 检 测 、 销 售 、 使 用 、 维 修 、 报 废 处 理 、 回 收 利 用 等 ， 
以 实现 优质 、 敏 捷 、 高 效 、 低 耗 、 清 洁 生 产 ， 快 速 响 应 市 场 的 需求 。 因 此 ， 当 前 
的 先进 制造 技术 是 以 产品 为 中 心 ， 以 光 机 电 一 体 化 的 机 械 制 造 技术 为 主体 ， 以 广 
义 制造 为 手段 ， 具 有 先进 性 和 时 代 感 。 

制造 技术 是 一 个 永恒 的 主题 ， 与 社会 发 展 密切 相关 ， 是 设想 、 概 念 、 科 学 技 
术 物 化 的 基础 和 手段 ， 是 所 有 工业 的 支柱 ， 是 国家 经 济 与 国防 实力 的 体现 ， 是 国 
家 工业 化 的 关键 。 现 代 制 造 技术 是 当前 世界 各 国 研究 和 发 展 的 主题 ， 特 别 是 在 市 
场 经 济 高 度 发 展 的 今天 ， 它 更 占有 十 分 重要 的 地 位 。 

信息 技术 的 发 展 并 引入 到 制造 技术 ， 使 制造 技术 产生 了 革命 性 的 变化 ， 出 现 
了 制造 系统 和 制造 科学 。 制 造 系统 由 物质 流 、 能 量 流 和 信息 流 组 成 ， 物 质 流 是 本 
KR, 能量 流 是 动力 ， 信 息 流 是 控制 ; 制造 技术 与 系统 论 、 方 法 论 、 信 息 论 、 控 制 
论 和 协同 论 相 结合 就 形成 了 新 的 制造 学 科 。 

制造 技术 的 覆盖 面 极 广 ， 涉 及 机 械 、 电 子 、 计 算 机 、 冶 金 、 建 筑 、 水 利 、 电 
子 、 运 载 、 农 业 以 及 化 学 、 物 理学 、 材 料 学 、 管 理科 学 等 领域 。 各 个 行业 都 需要 
制造 业 的 支持 ， 制 造 技 术 既 有 普遍 性 、 基 础 性 的 一 面 ， 又 有 特殊 性 、 专 业 性 的 一 
面 ， 制 造 技术 具有 共性 ， 又 有 个 性 。 

我 国 的 制造 业 涉及 以 下 三 方面 的 领域 : 

机 械 、 电 子 制造 业 ， 包 括 机 床 、 专 用 设备 、 交 通 运 输 工具 、 机 械 设备 、 电 
子 通信 设备 、 仪 器 等 

o 资源 加 工 工业 ， 包 括 石油 化 工 、 化 学 纤维 、 橡 胶 、 塑 料 等 ; 

。 轻 纺 工业 ， 包 括 服 装 、 纺 织 、 皮 草 、 印 刷 等 。 

目前 世界 先进 制造 技术 沿 着 全 球 化 、 绿 色 化 、 高 技术 化 、 信 息 化 、 个 性 化 和 
服务 化 、 集 群 化 六 个 方面 发 展 ， 在 加 工 技术 上 主要 有 超 精 密 加 工 技 术 、 纳 米 加 工 
技术 、 数 控 加 工 技术 、 极 限 加 工 技术 、 绿色 加 工 技术 等 ， 在 制造 模式 上 主要 有 自 
动 化、 集成 化 、 和 柔性 化 、 敏 捷 化 、 虚 氢化 、 网 络 化 、 智 能 化 、 协 作 化 和 绿色 
化 等 。 
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二 、 图 书 交流 源远流长 

近年 来 ， 国 际 间 的 交流 与 合作 对 制造 业 领域 的 发 展 、 技 术 进 步 及 重大 关键 技 
术 的 突破 起 到 了 积极 的 促进 作用 ， 制 造 业 科技 人 员 需 要 及 时 了 解 国外 相关 技术 领 
域 的 最 新 发 展 状况 、 成 果 取 得 情况 及 先进 技术 应 用 情况 等 。 

必须 看 到 ， 我 国 制造 业 与 工业 发 达 国 家 相 比 ， 仍 存在 较 大 差距 。 因 此 必须 加 
强 原 始 创 新 ， 在 实践 中 继承 和 改造 ， 学 习 国 外 的 先进 制造 技术 和 经 验 ， 提 高 自主 
创新 能 力 ， 形 成 自己 的 创新 体系 。 

国家 、 地 区 间 的 学 术 、 技 术 交 流 已 有 很 长 的 历史 ， 可 以 追溯 到 唐 朝 甚 至 更 远 
一 些 ， 唐 玄 美 去 印度 取经 可 以 说 是 一 段 典 型 的 图 书 交流 佳话 。 图 书 资料 是 一 种 传 
统 、 永 恒 、 有 效 的 学 术 、 技 术 交 流 方式 ， 旱 在 20 世纪 初期 ， 我 国清 代 学 者 严复 
就 翻译 了 英国 学 者 再 胥 黎 所 著 的 《天 演 论 》， 其 后 学 者 周 建 人 翻译 了 英国 学 者 达 
尔 文 所 著 的 《物种 起 源 》， 对 我 国 自 然 科学 的 发 展 起 到 了 很 大 的 推动 作用 。 

图 书 是 一 种 信息 载体 ， 图 书 是 一 个 海洋 ,虽然 现在 已 有 网 络 、 光 盘 、 计 算 机 
等 信息 传输 和 储存 手段 ， 但 图 书 更 具有 广泛 性 、 适 应 性 、 系 统 性 、 持 久 性 和 经 济 
性 ， 和 看书 总 比 在 计算 机 上 看 资料 要 方便 ， 不同 层 次 的 要 求 可 以 参考 不 同 层 次 的 图 
书 ,不 同 职业 的 人 员 可 以 参考 不 同类 型 的 技术 图 书 , 同时 它 具 有 比较 长 期 的 参考 
价值 和 收藏 价值 。 当 然 ， 技 术 图 书 的 交流 具有 时间 上 的 滞后 性 ， 不 够 及 时 ， 翻 译 
的 质量 也 是 个 关键 问题 ， 需 要 及 时 、 快 速 、 高 质量 的 出 版 工作 支持 。 

机 械 工业 出 版 社 希 望 能 够 在 先进 制造 技术 的 引进 、 消 化 、 吸 收 、 创 新 方面 为 
广大 读者 作出 贡献 ， 为 我 国 的 制造 业 科技 人 员 引 进 、 纳 新 国外 先进 制造 技术 的 出 
版 资源 ， 翻 译 出 版 国际 上 优秀 的 制造 业 先进 技术 著作 ， 从 而 能 够 提升 我 国 制造 业 
的 自主 创新 能 力 ， 引 导 和 和 推进 科研 与 实践 水 平 不 断 进 步 。 

三 、 选 译 严谨 质 高 面 广 

1) 精品 重点 高 质 本 套 丛书 作为 我 社 的 精品 重点 书 ， 在 内 容 、 纺 辑 、 装 帧 
设计 等 方面 追求 高 质量 ， 力 求 为 读者 奉献 一 套 高 品质 的 丛书 。 

2) 专家 选 译 把 关 ”本 套 从 书 的 选 书 、 翻 译 工作 均 由 国内 相关 专业 的 专家 、 
教授 、 工 程 技术 人 员 承 担 ， 充 分 保证 了 内 容 的 先进 性 、 适 用 性 和 翻译 质量 。 

3) 引 纳 地 区 广泛 ”主要 从 制造 业 比 较 发 达 的 国家 引进 一 系列 先进 制造 技术 
图 书 ， 组 成 一 套 “ 国 际 机 械 工程 先进 技术 译 从 ”。 当 然 其 他 国家 的 优秀 制造 科技 
图 书 也 在 选择 之 内 。 

4) 内 容 先 进 丰 富 在 内 容 上 应 具有 先进 性 、 经 典 性 、 广 泛 性 ， 应 能 代表 相 
关 专 业 的 技术 前 沿 ， 对 生产 实践 有 和 较 强 的 指导 、 借 鉴 作用 。 本 套 从 书 尽量 涵盖 制 
造 业 各 行业 ,例如 机 械 、 材 料 、 能 源 等 ， 既 包括 对 传统 技术 的 改进 ， 又 包括 新 的 
设计 方法 、 制 造 工艺 等 技术 。 

5) 读者 层次 面 广 ” 面 对 的 读者 对 象 主要 是 制造 业 企业 、 科 研 院 所 的 专家 、 


EARS "V. 


研究 人 员 和 工程 技术 人 员 ， 高 等 院 校 的 教师 和 学 生 ， 可 以 按照 不 同 层 次 和 水 平 要 
求 各 取 所 需 。 
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《精密 运动 控制 : 设计 与 实现 》 是 新 加 坡 国立 大 学 Tan Kok Kiong 博士 、Lee 
Tong Heng 博士 和 Huang Sunan 博士 对 精密 运动 控制 系统 多 年 研究 和 应 用 成 果 的 
总 结 ， 特 别 是 第 2 版 经 过 精心 选择 和 修改 ， 使 得 《精密 运动 控制 : 设计 与 实现 》 
更 加 全 面 完善 。 所 译 Springer 出 版 社 出 版 的 《精密 运动 控制 : 设计 与 实现 》 Ok 
书 第 2 版 ) 不 但 阐述 了 精密 运动 控制 的 基本 原理 ,而且 就 实现 精密 运动 控制 的 各 
个 环节 做 了 详细 的 描述 ， 特 别 是 每 一 章 中 对 应 给 出 了 试验 结果 ， 这 对 实际 应 用 精 
密 运 动 控制 技术 的 技术 人 员 来 说 ， 是 非常 有 益 的 。 本 书 内 容 涉及 精密 运动 控制 装 
置 、 各 种 控制 方案 、 光 学 测量 方法 和 误差 补偿 原理 。 为 了 得 到 精确 的 测量 结果 ， 
本 书 还 专门 介绍 了 机 械 控 制 系 统 的 稳定 性 和 静 定 问题 ， 以 及 现场 总 线 通信 技术 问 
题 。 由 此 可 见 ， 精 密 运 动 控制 是 涉及 机 械 、 控 制 、 电 子 、 光 学 和 通信 的 综合 技 
AR, 本 书 对 机 械 、 电 气 、 测 量 仪表 和 自动 化 领域 的 工程 技术 人 员 来 说 既是 一 本 很 
好 的 新 技术 原理 图 书 ， 也 是 一 本 精密 运动 控制 系统 应 用 的 简明 技术 手册 。 

译 者 非常 高 兴 有 机 会 将 此 书 介 绍 给 广大 的 中 文 读 者 。 译 者 主要 的 工作 是 将 此 
书 由 英文 版 译 为 中 文 版 ， 在 保证 原著 译文 准确 的 基础 上 ， 还 考虑 了 汉语 修辞 和 表 
达 的 习惯 。 译 者 感谢 Springer 出 版 社 和 机 械 工业 出 版 社 对 翻译 出 版 本 书 提供 的 帮 
助 。 在 翻译 本 书 的 过 程 中 ， 韩 希 也 做 了 部 分 翻译 和 整理 工作 ， 在 此 表示 感谢 。 
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20 世纪 以 来 ， 精 密 制 造 业 从 研究 、 开 发 和 应 用 到 产品 创新 方面 一 直 保 持 稳 
步 发 展 的 势头 ， 并 引起 了 广泛 关注 。 这 种 发 展 的 动力 似乎 来 自 于 以 下 要 求 : BOK 
越 高 的 产品 性 能 、 更 高 的 可 靠 性 、 使 用 寿命 长 、 低 成 本 和 小 型 化 。 这 种 发 展 也 广 
泛称 为 精密 工程 ， 精 密 工 程 如 今 通常 被 定义 为 公差 小 于 10”: 1 的 加 工 制造 。 

可 以 说 精密 工程 的 历史 源 于 钟表 领域 ， 涉 及 计时 器 、 钟 表 和 光学 仪器 的 开 
发 ， 如 反光 镜 、 望 远 镜 和 显微镜 镜头 制造 。 在 19 世纪 末 和 20 世纪 初 ， 促 进 精 密 
机 床 和 精密 仪器 发 展 的 主要 技术 是 量规 制造 刻度 、 刻 线 和 光谱 衍射 光栅 。 现 在 ， 
计算 机 控制 下 超 精 密 机 床 可 以 确定 相对 于 工件 的 定位 ， 其 分 辨 率 和 定位 精度 小 于 
微米 。 必 须 指出 ， 可 实现 的 “加 工 ” 准 确 性 不 仅 包括 使 用 机 床 加 工 和 研磨 技术 ， 
而 且 还 包括 使 用 能 量 束 加 工 ， 如 等 离子 束 和 电子 束 加 工 ， 以 及 表面 测量 的 扫描 探 
针 系 统 与 取 放 类 操作 。 

进入 21 世纪 ， 超 精密 制造 保持 持续 的 发 展 速度 ， 进 入 了 纳米 级 尺度 系统 
(纳米 技术 ) 。 不 断 增 加 的 集成 电路 封装 密度 和 半导体 最 小 特征 尺寸 的 持续 突破 
加 快 了 超 精 密 工程 发 展 的 步伐 。 新 兴 技 术 如 微 电 子 机 械 系统 (MEMS)， 在 欧洲 
也 称 为 微 系统 技术 《MST) ， 进 一 步 扩展 了 机 电 部 件 一 体 化 和 小 型 化 的 范围 。 

本 书 是 重大 项 目 “ 开 发 先进 高 速 超 精 密 机 器 人 ”的 成 果 和 论文 的 汇编 ， 重 
点 是 实现 精密 运动 定位 系统 的 应 用 技术 。 对 这 一 重点 全 面 和 彻底 的 论述 适合 从 研 
究 者 到 从 业 人 员 等 的 广大 读者 群 ， 本 书 提供 的 技术 内 容 都 经 过 详细 的 试验 验证 。 

本 书 首先 介绍 了 精密 工程 ， 并 对 其 发 展 过 程 和 应 用 提供 了 简要 的 概括 。 第 2 
章 介绍 了 实现 运动 系统 的 高 精度 运动 控制 的 控制 系统 技术 ， 提 出 了 可 以 让 跟踪 精 
度 性 能 更 高 的 智能 控制 方案 。 这 些 控制 方案 根据 现 有 的 有 效 信息 和 操作 性 质 ， 应 
用 了 先进 控制 理论 和 人 工 智 能 的 不 同 组 合 。 这 些 方案 包括 自 适应 控制 、 线 性 和 非 
线性 控制 元 件 的 复合 控制 方案 、 自 适应 波纹 补偿 方案 、 干 扰 观 测 和 补偿 方案 ， 以 
及 学 习 控 制 策略 。 提 供 适当 试验 结果 来 比较 和 核查 标准 控制 器 性 能 及 其 可 实现 的 
改进 ,清楚 论述 了 使 用 高 等 级 加 速度 计 直 接 测量 加 速度 ， 增 加 状态 反馈 可 提高 实 
现 的 跟踪 性 能 。 同 时 本 书 介绍 的 技术 和 器 件 非 常 通用 ， 可 供 广大 研究 者 和 从 业 人 
员 参 考 。 

第 3 章 介绍 了 基于 闭环 诱发 持续 小 幅 振 荡 的 继 电 反 馈 配 置 和 技术 ,适合 为 运 
动 系统 建立 标 称 模型 。 这 样 ， 第 2 章 提 出 的 控制 系统 可 以 自动 整定 和 运行 ， 并 仍 
可 以 达到 令 人 满意 的 性 能 。 第 3 章 给 出 了 基本 配置 的 多 种 变化 ， 以 方便 利用 摩擦 
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效应 进行 自动 建 模 。 这 些 模 型 可 以 用 于 运行 前 馈 和 反馈 控制 器 ， 对 自 适应 控制 初 
始 化 也 有 用 处 。 第 3 章 还 提供 了 从 嘲 杂 的 继电器 振荡 中 提取 最 优 特征 的 方案 。 
第 4 章 给 出 了 一 个 精密 笛 卡 儿 机 器 人 系统 的 通用 配置 一 一 移动 龙门 台 ， 这 是 
"晶片 步 进 机 和 高 分 辨 率 装配 机 经 常 采 用 的 配置 。 除 了 个 别 伺 服 跟 踪 要 求 外 ， 有 必 
要 使 并 行 伺 服 系 统 串联 运动 ， 以 降低 轴 间 的 偏差 。 第 4 章 中 给 出 了 不 同 的 控制 配 
置 ， 并 比较 了 它们 的 性 能 ， 这 些 配 置 包括 了 现 有 的 工业 控制 系统 应 用 及 最 近 发 展 

的 控制 方案 。 

第 5 章 介绍 了 几何 误差 校正 和 补偿 问题 的 综合 处 理 方法 ， 系 统 论述 了 : 几何 
误差 的 来 源 、 测 量 用 的 校准 设备 、 控 制 系统 原始 数据 处 理 和 对 最 终 补偿 的 建 模 。 
第 5 章 也 包括 几何 校正 和 补偿 的 最 新 进展 和 更 新 ， 介绍 了 几何 误差 建 模 使 用 的 人 
工 智 能 (AI) 方法 。 该 章 还 介绍 了 可 行 概率 方法 ， 用 来 减少 随机 误差 对 系统 误 
差 补偿 产生 的 不 利 影响 。 

第 6 章 明确 地 讨论 了 测量 系统 。 精 密 运 动 控制 只 有 靠 精密 运动 的 测量 才能 实 
更。 编码 器 插 补 是 一 种 有 效 控制 成 本 的 方式 ， 用 来 获得 良好 的 位 置 测量 分 辩 率 。 
这 种 技术 纠正 了 编码 器 信号 的 缺点 ， 并 能 从 纠正 信号 中 获得 更 高 的 分 辨 率 ， 实 现 
了 控制 系统 对 输入 信和 号 高 分 辩 率 的 要 求 。 

第 7 章 涉及 振动 监测 与 控制 的 话题 ， 并 提出 了 三 种 办 法 。 第 一 个 方法 的 重点 
是 放 在 正确 的 机 械 设 计 上 ， 基 于 机 械 结构 的 确定 性 将 机 械 振动 减少 到 最 低 限度 。 
第 二 种 方法 是 基于 陷 波 器 及 其 应 用 ， 陷 波 器 作为 控制 系统 的 一 部 分 ， 用 来 抑制 可 
能 激发 不 良机 械 共振 的 频率 。 用 一 种 基于 快速 侍 里 叶 变 换 (FFT) 的 自 适应 技术 
跟踪 共振 频率 ， 并 相应 地 修改 了 滤波 器 。 第 三 种 方法 使 用 了 传感器 融合 技术 ,来 
监测 和 分 析 精 密 机 械 振动 。DSP 器 件 用 来 获取 在 正常 运转 情况 下 的 机 械 振动 特 
征 。 当 机 器 偏离 正常 运转 状况 时 ， 该 设备 可 以 检测 到 异常 ， 并 启动 适当 的 故障 诊 
断 和 维修 措施 。 

最 后 ， 第 8 章 对 高 精密 运动 控制 系统 的 其 他 重要 的 工程 方面 进行 了 讨论 。 这 
些 方面 包括 组 件 选择 后 的 考虑 、 硬 件 结构 、 软 件 开发 平台 、 用 户 界面 设计 和 评估 
测试 ， 这 些 是 确定 高 精密 运动 控制 系统 和 数字 通信 协议 最 终 成 功 与 否 的 关键 。 本 
书 主要 在 控制 工程 和 软件 计算 范畴 内 ， 提 供 了 更 广泛 和 更 新 颖 的 精密 运动 控制 方 
法 和 算法 。 

与 第 1 版 相 比 ,第 2 版 中 进行 了 一 系列 的 修改 、 更 新 和 扩展 。 第 1 版 出 版 约 
6 年 后 ， 精 密 工程 一 直 处 在 控制 工程 的 重要 领域 ， 出 现 了 许多 新 的 成 果 。 

在 第 1 版 之 基础 上 ,第 2 版 义 增加 了 新 内 容 ， 包 括 压 电 驱动 器 建 模 与 控制 
(第 2 章 ) 、 自 适应 协调 控制 方案 〈 第 4 章 ) 、 人 参数 模型 插值 (第 6 章 ) 、 减 少 振 
动 的 机 械 设计 (第 7 章 ) 和 数字 通信 协议 〈 第 8 章 ) 。 引 言 章节 也 进行 了 大 幅度 
的 修订 ， 以 反映 精密 运动 控制 技术 发 展 的 最 新 状态 。 


Olt 


前 eK. 





没有 以 下 的 同事 和 朋友 的 慷慨 帮助 ， 就 不 可 能 成 就 这 本 书 ， 他 们 是 Lim Ser 
Yong 博士 、Andi Sudjana M+, Teo Chek Sing 硕士 、Tang Kok Zuea 博士 、Zhou 
Huixing 博士 和 Jiang Xi 硕士 。 衷 心 感谢 他 们 在 本 书写 作 过 程 中 提供 的 真诚 帮助 。 
还 要 感谢 新 加 坡 (新加坡 国立 大 学 ) 和 新 加 坡 制造 技术 研究 院 联 合资 助 的 项 目 ， 
书 中 论述 的 内 容 大 多 源 自 这 些 项 目的 信息 和 成 果 。 也 感谢 惠普 公司 (Hewlett 
Packard) 提供 了 有 关 激 光 测 量 系统 的 数据 和 资料 。 最 后 ， 谨 以 此 书 献 给 爱 我 们 
和 支持 我 们 的 家 庭 成 员 。 


Tan Kok Kiong 
Lee Tong Heng 
Huang Sunan 


2007 年 5 月 ， 新 加 坡 


译 丛 序言 
译 者 序 
A 
第 1 章 引言 1 
1.1 需要 精密 控制 的 领域 1 
1.1.1 精密 工程 pe 1 
1.1.2 微 制 造 en 3 
1.1.3 ”生物 技术 ee 5 
1.1.4 纳米 技术 ee 5 
1.2 ”精密 机 械 和 工具 pe 6 
1.3 ”精密 运动 控制 系统 的 应 用 pp 7 
1.4 本 书 的 范围 et 8 
第 2 章 ”精密 跟踪 运动 控制 9 
2.1 压 电 驱动 器 serrrererrenneernenrsrtnrnereensntorteerasnnsnnsertrosresnrrosttteraneveunrncorreesrurarnat 9 
2.1.1 压 电 驱动 器 配置 的 类 型 RN 9 
2.1.2 数学 模型 pp 10 
2.1.3 自 适 应 控制 pe 15 
2.2 永 磁 直线 电动 机 (PMLM) CC 20 
2.2.1 PMLM 的 类 再 pp 20 
2.2.2 数学 模型 ee 22 
2.2.3 力 的 波动 23 
2.2.4 JEJA SELES TESTES EES Eee eee ee eee eee eee eee eee 5. 
2.2.5 复合 控制 25 
2.2.6 加 速度 控制 增强 32 
2.2.7 波动 补偿 38 
2.2.8 干扰 观测 及 消除 en 44 
2.2.9 和 鲁 棱 自 适 应 控制 51 
2.2.10 迭代 学 习 控 制 ean 56 
第 3 章 ”控制 参数 的 自 整定 PR 63 
3.1 继电器 自 整定 nn 63 
3.1.1 延 时 继 电 髓 nn 64 


3.1.2 双 通 道 继电器 整定 nn 65 








3.2 ”摩擦 建 模 使 用 继电器 反馈 65 
3.2.1 摩擦 辨识 方法 on 上 【上 上 66 
3.2.2 模拟 上 68 
3.2.3” 自 适应 控制 的 初始 化 ee 69 

3.3 ”继电器 振 功 的 最 优 特征 提取 pp 71 

3.4 试验 ee 72 

第 4 章 龙门 系统 的 协调 运动 控制 pp 75 

4.1 协调 控制 方案 en 76 
4.1.1 经 典 主 / 从 方法 eee】 上 上】 76 
4.1.2 设 定点 协调 控制 77 
4.1.3 ”整体 协调 控制 78 

4.2 仿真 研究 pp 79 

“4.2.1 控制 任务 79 
4.2.2 结果 80 

4.3 试验 ee 82 
4.3.1 XY 工作 台 一 一 配置 ee i. 83 
4.3.2 XY 图 表 一 一 配置 全 ee 上 上】 上 86 

4.4” 自 适应 协调 控制 方案 ee 88 
4.4.1 龙门 台 的 动态 建 模 pe 88 
4.4.2 基于 模型 的 自 适 应 控制 设计 ee 91 
4.4.3 稳定 性 分 析 Ne 93 
4.4.4 软件 仿真 “pet 93 
4.4.5 实施 结果 Ne 96 

第 5 章 ”几何 误差 补偿 98 

5.1 激光 测量 系统 概述 pp 99 

$.2 激光 测量 系统 的 组 件 Ne 99 
5.2.1 激光 头 cet et cent cee ee eee en eee teen ene en eneeeeneeeeseeetennee nee eeeeenseeeeeeeseesaeatnasecenaes 100 
5.2.2 干涉 仪 和 反射 器 100 
5.2.3 ”测量 接收 机 101 
5.2.4 测量 与 控制 电子 电路 eerererrererrerrrressrverrrerresrresureerureenresnpestesarsrorssresnree 102 

5.3 ”激光 校准 概述 102 
5.3.1 线性 测量 103 
5.3.2 角度 测量 103 
5.3.3 ”直线 度 测量 pp 104 
5.3.4 WWE en 104 

5.4 使 用 水 平 敏感 设备 的 滚动 测量 Ne 105 

5.5 HERE DEG .pp 106 


5.6 ”影响 测量 精度 的 因素 vn eeeeee cee eeesee cece sneeeeeeteeeescnsseetscsesceescaeseneeeetteetetetans 107 


"I: 精密 运动 控制 : 设计 与 实现 





5.6.1 线性 测量 误差 ee Bo 107 
5.6.2 角 测 量 误差 veee 生生 108 
5.6.3 直线 度 测量 误 益 Ne 108 
5.6.4 ”环境 条 件 Ne 109 
5.7 ,总体 误差 模型 nn 110 
5.8 几何 误差 的 查 表 pp。 111 
5.9 ”几何 误差 的 参数 化 模型 112 
5.9.1 径 向 基 函 数 与 误差 建 模 和 113 
5.9.2 人 参数 误差 通 近 pp 113 
5.9.3 试验 pe 118 
5.9.4 使 用 多 层 神 经 网 络 误差 建 模 pp 121 
5.10 ”随机 误差 的 机 机 补偿 123 
5.10.1 概率 方法 pp 123 
5.10.2 试验 pe 125 
b= op = eee 131 
6.1 海德 曼 捅 值 法 E Lee 131 
6.1.1 插值 界 pp 133 

6. 1.2 校准 和 补偿 eee 134 
6.2 增强 插值 法 nn 134 
6.2.1 增强 插值 法 的 原理 135 

6. 2.2 构建 一 个 查 表 pe 135 
6.2.3 试验 和 ee 140 
6.3 ”插值 的 参数 模型 ppp 142 
6.3.1 插值 方法 的 原理 ee 142 
6.3.2” 预 补偿 阶段 ccccceceececccecerneeeaseeeaeeneeaeeeueeeneeneeeseeeesessseeterereeeeeeeseteeeeeees 143 
6.3.3 ”插值 阶段 cnn eect tec e cece ee eee nena ne neea ee nee ene nen ene ene ens ten ers ene eee seesneneeneeeeenas 145 
6.3.4 试验 研究 和 pp 146 
第 7 章 振动 监测 与 控制 RN 149 
7.1 机 械 设 计 中 尽量 减少 振动 Nt 149 
7.1.1 机 械 结 构 的 稳定 性 和 静 定 性 RN 150 
7.1.2 二 维 结构 Ne 150 
7.1.3 三 维 结构 oo 154 
7.2 MMRR eee 159 
7.2.1 快速 傅 里 时 变换 站 pe 161 
7.2.2 模拟 We 161 
7.2.3 试验 163 
7.3 实时 振动 分 析 仪 pp 164 





7.3.2 ”监测 模式 165 
7.3.3 诊断 模式 和 167 
7.3.4 试验 168 
7.3.5 远程 监控 cece cece eee ee tent ecenecnet ents eee e enter neeneenraaaasaeesseaeseccenteneeesnenasagenes 174 
7.3.6 实现 ee 176 

第 8 章 = po: EOE 179 
8.1 规格 179 
8.2 ”选择 电动 机 和 了 驱动 器 pp 179 
8.3 ”选择 光学 编码 器 180 
8.4 控制 平台 eeeeerreererrererrtttteserestenrirreenertnsrrrenerrrnnnetrnnvesrreeeverereetnnensetatennt 180 
8.4.1 硬件 绪 构 EEEEE EOE OTSOOEOEESSOOSOOSOSOOSSOSESSSOSOSOOOSOES® 180 
8.4.2 软件 开发 平台 ce 182 
8.4.3 ”用户 界 面 和 185 

8.5 ”精度 测量 T 186 
8.6 数字 通信 协议 ppp nt 187 
8. 6. 1 现场 总 线 协 议 械 vere eee e cee ee eter een nertteeeeeneeeteeensensceernsneaanansasanenens 188 
8.6.2 常见 的 现场 总 线 和 190 
附录 激光 校准 光学 仪器 、 附 件 和 配置 196 


第 1 章 引 F 


精密 控制 是 超 精密 机 械 技术 的 核心 。 精 心 选 择 的 控制 策略 将 使 机 械 系 统 实现 
全 面 完 整 的 控制 和 补偿 ， 进 而 获得 系统 的 精确 定位 。 当 前 ， 高 精密 运动 控制 领域 
是 一 个 令 人 十 分 感 兴趣 的 研究 课题 。 本 书 讨论 的 精密 控制 技术 已 经 广泛 应 用 于 下 
列 领域 : 

1) 精密 工程 。 

2) 微 制造 。 

3) 生物 技术 。 

4) 纳米 技术 。 


1.1 需要 精密 控制 的 领域 


1.1.1 精密 工程 


加 工 是 制造 业 中 使 用 机 械 工具 去 除 多 余 或 不 想 要 物质 的 一 个 主要 过 程 ， 例 
如 ， 切 割 、 研 磨 和 精 加 工 。 常 规 加 工 通过 车 床 、 钻 床 、 铣 床 等 机 器 执行 。 尽 管 这 
些 机 器 仍然 在 使 用 ， 但 是 加 工 工艺 的 发 展 为 生产 高 精确 度 元 部 件 提供 了 新 的 和 非 
传统 加 工 方法 ， 例 如 ， 采 用 激光 切割 和 化 学 物质 等 。 当 前 加 工 技术 的 发 展 趋势 是 
采用 非 接触 式 加 工 ， 而 不 是 接触 式 加 工 。 

1. 超 精密 主轴 

超 精 密 主 轴 以 高 速 、 中 或 低 的 扭矩 来 驱动 负载 。 超 精密 主轴 可 制造 高 精密 设 
备 〈 如 高 速 车 床 和 铣床 ) ， 以 及 非 制造 业 设备 〈 如 高 性 能 磁 记 忆 磁 盘 文 件 系 统 、 
高 清晰 大 型 投影 仪 ) 。 这 些 应 用 要 求 定位 高 度 精 确 ， 同 时 还 要 实现 高 速 ， 因 此 构 
成 了 挑战 。 

为 实现 系统 的 要 求 特别 应 用 了 空气 轴承 。 空 气 轴承 的 特点 是 低 误差 异步 运 
动 ， 使 其 有 可 能 实现 高 精度 旋转 。 它 的 缺点 是 低 刚度 和 低 阻 尼 力 。 图 1. 1 所 示 为 
空气 轴承 的 工作 框图 ， 压 缩 空气 用 来 充满 机 器 旋转 部 件 〈 如 主轴 ) 和 静态 部 件 
之 间 的 间隙 。 

为 实现 高 刚度 ， 已 开发 出 集 空 气 轴承 与 传统 轴承 (润滑 油 润滑 的 ) 为 一 体 
的 混合 解决 方案 。 
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图 1.1 空气 轴承 


2. 准 分 子 激光 微 加 工 

激光 器 ， 特 别 是 准 分 子 激光 器 ， 由 于 其 独特 的 脉冲 紫外 线 (UV) 放射 ， 如 
今 已 经 广泛 应 用 于 不 同 种 类 材料 的 微 加 工 中 。1977 年 以 来 ， 准 分 子 激光 器 一 直 
用 于 试验 室 的 研究 。 大 约 10 年 后 ， 它 们 已 成 功 引 入 了 工业 加 工 和 制造 业 。 准 分 
子 激 光 器 已 用 于 玻璃 (如 眼镜 ) 和 陶瓷 高 精度 标记 ， 尤 其 是 在 表面 贴 装 系统 
(SMD) 。 在 微 电 子 生产 线 方面 ， 印 制 线路 板 钻 孔 可 以 借 此 技术 完成 。 在 半导体 
加 工 方 面 ， 它 可 以 作为 直接 写 人 工具 取代 照相 掩 模 ， 或 作为 一 个 处 理 多 层 芯 片 的 
微型 外 ， 并 可 作为 进行 半导体 工艺 的 非 化 学 蚀刻 和 修理 的 消融 工具 。 

BRED TBO HEA TE DA AS RAR, ORT ， 
气体 是 由 于 它们 的 稳定 性 好 。 为 了 保持 精度 ， 控 制 气体 的 流动 和 压力 是 必要 的 。 
准 分 子 激 光 控 制 包 括 控制 排 气 滤 清 器 、 真 空 泵 和 气体 混合 器 。 

3. 精密 计量 与 测试 

坐标 测量 仪 (CMM) 的 测量 精度 每 年 都 在 持续 提高 。 坐 标 测量 仪 安装 了 精 
密 工 具 ， 如 探 针 、 视 觉 装 置 和 显微镜 ， 这些 机 器 在 计量 和 测试 领域 可 以 进行 一 些 
寺 殊 的 应 用 ， 扫 描 探 针 显 微 镜 (SPM) 就 是 其 中 一 种 。 

第 一 代 扫 描 探 针 显 微 镜 是 电子 束 聚 焦 在 目标 物 的 一 个 小 点 上 ， 并 且 电 磁 光 栅 
横向 扫 摘 的 电子 显微镜 (SEM) 。 通 过 收集 冲击 电子 束 碰撞 产生 的 二 次 电子 生成 
图 像 ， 或 者 通过 检测 背 散 射电 子 生成 图 像 ， 或 者 通过 检测 产生 的 X 射线 生成 图 
像 。 通 过 这 种 方式 ， 显 微 镜 就 可 以 描述 目标 物体 几 个 不 同方 面 的 特征 ， 包 括 形 
态 、 平 均 原 子 数 目 和 成 分 。 

在 扫描 隧道 显微镜 (STM) 技术 中 ， 瞬 逝 波 是 一 个 固有 波长 约 lnm 的 电子 
波 函 数 ， 延 伸 超 过 尖锐 的 金属 探 针 表 面 。 如 果 探 针 接近 导电 体 表面 在 约 1nm 的 
范围 内 ， 并 且 两 者 之 间作 用 有 电位 差 ， 随 后 将 产生 感应 隧道 电流 。 这 个 电流 的 大 
小 是 一 个 按 指数 衰减 的 距离 函数 ， 并 且 还 取决 于 两 个 材料 性 能 的 差异 。 于 是 可 以 
得 到 被 测 材料 表面 形状 和 其 化 学 成 分 的 信息 。STM 技术 的 局 限 性 是 它 只 可 以 在 


第 1 章 引 


o 
ww 





导体 表面 使 用 。 

力 扫描 显微镜 (SFM) 通常 称 为 原子 力 显 微 镜 (AFM) ， 目 前 已 经 可 以 克服 
STM 的 局 限 。 仪 器 使 用 金箔 架 上 的 钻石 针 轻 轻 扫描 整个 样本 表面 ， 检 测 作用 在 
针尖 上 的 斥 力 。 当 针尖 接近 样本 表面 时 ， 受 到 范 德 华 (Vander Waals) 引力 影 
响 ， 可 以 感知 悬臂 共振 频率 的 变化 。 这 类 显 微 技 术 广泛 应 用 于 表面 特征 描述 ， 包 
括 影像 和 形状 。 


1.1.2 微 制造 


20 世纪 的 重大 发 明之 一 是 微 电 子 学 、 微 装置 科学 。 微 装置 科学 可 以 设计 和 
制作 出 亚 微米 大 小 的 集成 电路 。 微 制造 涵盖 一 系列 的 制造 过 程 ， 这 些 制造 过 程 产 
生 材 料 的 图 案 和 层次 形成 微观 结构 。 光 刻 技术 和 微机 电 系 统 (或 微 系 统 ) 是 微 
制造 过 程 常 见 的 应 用 。 微 组 装 则 是 精密 工程 的 另 一 个 重要 的 过 程 。 

1. 光 刻 技术 

半导体 和 微 电 子 行业 的 发 展 及 应 用 产生 了 电子 束 光 刻 技术 ， 电 子 束 光 刻 技术 
在 未 来 大 规模 生产 中 将 成 为 产品 持续 小 型 化 的 主要 技术 基础 。 使 用 电子 束 光 刻 技 
术 将 性 能 和 尺寸 都 印 在 硅 芯 片上 称 为 光 刻 法 ， 其 中 从 录 燕 气 灯 照射 紫外 线 光 通 过 
包含 芯片 特征 的 掩 模 投 影 到 机 器 硅 晶 片 的 表面 ， 机 器 被 称 为 光 刻 “ 步 进 器 " Z 
所 以 被 称 为 “ 步 进 器 ”， 是 因为 它 在 芯片 上 印 图 像 后 ， 唱 片 “ 步 进 ”到 下 一 个 位 
置 ， 印 下 一 个 图 像 。 对 于 尺寸 小 于 0. 1mm 的 特征 ， 可 使 用 更 短 形式 波长 的 电子 
RER X 射线 辐射 。 

超大 规模 集成 电路 (ULSI) 芯片 是 精密 光 刻 的 结果 。 这 些 芯 片 正 在 迅速 向 
更 小 、 更 快 、 更 便宜 、 配 备 更 多 的 内 存 的 方向 发 展 。 科 学 研究 者 们 期 待 它们 给 微 


处 理 器 和 计算 机 的 性 能 带 来 进一步 的 、 巨 大 的 改进 。 图 1. 2 所 示 为 光 刻 工艺 过 
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图 1.2 光 刻 工艺 过 程 
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程 ， 主 要 显示 了 工序 的 控制 配置 。 在 这 个 工艺 过 程 中 ， 采 用 了 压 电 陶瓷 。 压 电 物 
质 通常 是 由 陶瓷 制 成 的 材料 ， 具 有 把 电信 号 (BE) 转化 为 精度 达 纳 米 级 的 运 
动 的 能 力 。 这 个 压 电 陶瓷 管 驱动 器 驱动 悬臂 ， 悬 璧 反 过 来 又 推动 硅 唱 探 针 尖 。 硅 
晶 探 针尖 是 电子 源 ， 在 工作 对 象 上 光 刻 图 形 。 因 此 ， 整 个 系统 的 性 能 主要 取决 于 
压 电 陶瓷 运动 的 精度 。 光 刻 是 压 电 材料 应 用 的 一 个 示例 ， 说 明 材 料 科 学 的 发 展 也 
将 促进 和 影响 运动 系统 的 发 展 。 

2. 微 电 子 机 械 系统 (MEMS) 

微 电 子 机 械 系 统 是 机 械 和 电子 元 件 的 集合 ， 包 括 传感器 和 驱动 器 ， 其 共同 基 
底 通 常 是 硅 。 微 电子 机 械 系统 元 件 采用 微 加 工 工 艺 ， 有 选择 地 刻 蚀 部 分 硅 片 或 者 
添加 新 的 结构 层次 形成 预期 的 结构 。 利 用 微 电 子 机 械 系 统 ， 可 以 开发 片上 系统 
(system-on-chip) ， 片 上 系统 通常 用 来 指 多 功能 芯片 。 

从 早期 的 加 速度 计 和 陀螺 仪 ， 到 具有 微机 械 功 能 的 专用 传感器 、 传 感 器 阵 
列 ， 再 到 完全 集成 到 同一 个 硅 芯 片上 的 驱动 器 ， 微 电子 机 械 系 统 产品 已 经 莲 勃 发 
展 起 来 ， 其 应 用 还 将 会 扩大 到 汽车 导航 、 生 物 医 学 和 制药 等 各 行业 。 

3. 微 组 装 

另 一 个 高 精度 的 工艺 涉及 微 组 装 领域 。 组 装 芯片 倒 装 是 微 装 配 工艺 的 一 个 例 
子 。 倒 装 芯片 是 安装 在 基板 上 的 一 个 芯片 ， 使 用 各 种 相互 连接 的 材料 并 采用 多 种 
安装 方法 实现 ， 如 卷 带 自动 结合 、 无 助 溶剂 的 焊剂 凸 点 、 线 连接 、 各 向 同性 和 各 
向 异性 导电 粘 结 剂 、 金 属 凸 点 、 和 柔顺 性 凸 点 、 压 力 接触 ， 只 要 芯片 的 表面 (有 
源 区 或 V0 m) 一 直面 向 着 基 座 。 

最 早 的 一 种 倒 装 芯片 技术 是 凸 点 焊接 倒 装 芯片 技术 ， 它 是 一 种 取代 手工 操作 
面 朝 上 的 线 焊 技 术 ， 该 技术 既 昂 贵 又 不 可 靠 ， 且 生产 率 低下 。 凸 点 是 将 熔融 焊料 
注射 到 整个 晶片 上 玻璃 模具 板 腔 蚀 孔 内 而 形成 的 。 模 具 板 被 加 热 到 恰好 低 于 焊剂 
的 熔点 。 喷 注 器 包括 一 个 稍微 加 压 的 各 类 熔融 焊剂 库 。 图 1. 3 所 示 为 焊剂 凸 点 沉 
积 的 工艺 过 程 。 
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图 1.3 焊剂 凸 点 沉积 的 工艺 过 程 


最 近 几 年 制造 集成 电路 装置 的 倒 装 芯片 技术 应 用 发 展 势头 迅猛 。 随 着 装置 越 
来 越 小 ， 对 芯片 上 焊 点 在 基板 的 垫上 排列 的 精度 要 求 变 得 更 高 了 。 
除了 倒 装 芯片 装配 外 ， 还 可 以 利用 高 精度 的 装配 机 器 人 来 装配 徽 电 子 和 机 械 
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部 件 。 
1.1.3 生物 技术 


生物 技术 是 操纵 生物 系统 结构 和 功能 的 技术 ， 特 别 用 于 食品 科学 、 农 业 和 医 
学 。 现 代 生物 技术 往往 与 活性 材料 的 遗传 改变 有 关 ， 如 微生物 、 植 物 和 动物 。 
生物 技术 应 用 实例 包括 : 

1) 微 创 外 科 手 术 。 借 助 于 遥控 操作 手术 器 械 和 诊断 工具 ， 如 微 导管 直径 下 
降 到 100km， 结 合用 光纤 高 分 辨 率 摄像 机 传输 及 检索 光 图 像 ; 用 纳米 级 传感器 
测量 血液 化 学 性 质 ， 安 装 在 末端 的 微型 涡轮 旋转 刀具 用 来 清除 动脉 斑 块 。 

2) 卵 胞 浆 内 单 精子 注射 (ICSI) 。 把 精子 注射 到 卵细胞 需要 高 精密 驱动 器 ， 
以 帮助 受精 成 功 并 尽量 减少 带 给 细胞 的 损失 。 

3) 依靠 纳米 粒子 技术 ， 准 确 和 高 效 地 命中 目标 和 传送 药物 。 

4) 用 人 工 神经 更 换 损 坏 的 神经 。 

5) 将 改进 的 活 组 织 细胞 黏附 在 供 修复 术 的 植 人 体 上 ， 进 行 植 和 信物 材料 的 微 
纳米 表面 排列 。 另 一 种 纳米 技术 生物 医学 应 用 是 制造 微型 的 生物 芯片 ， 这 种 技术 
有 时 被 称 为 “芯片 上 的 试验 室 " 。 

下 面 简要 介绍 生物 芯片 和 高 密度 传感器 阵列 的 内 容 。 

生物 检测 通常 需要 进行 10: ~ 10° 项 的 检测 ， 包 括 筛选 潜在 药物 化 合 物 和 各 
种 协议 库 ， 对 遗传 物质 进行 筛选 及 序列 分 析 。 这 么 大 的 数量 要 求 化 学 检验 并 行 处 
理 ， 以 便 在 合理 的 时 间 内 完成 ， 通 常 获得 的 只 有 小 样本 数量 ， 则 要 求 传感器 小 尺 
寸 。 因 此 ， 研 究 者 对 类 似 生物 传感器 的 微 制造 传感器 元 件 高 密度 阵列 进行 了 研 
究 ， 其 中 单个 元 素 的 大 小 接近 了 纳米 技术 范围 。 这 种 方法 往往 称 为 “生物 芯 
E”, 通常 意味 着 综合 生物 学 与 芯片 类 型 技术 。 例 如 ， 正 在 研制 的 基因 第 选 设备 
含有 二 维 阵列 大 于 1 x 10° 个 元 素 ， 各 有 不 同 的 DNA 序列 ， 要 对 每 个 元 素 进行 光 
学 检验 ， 与 互补 的 遗传 物质 进行 专门 的 相互 作用 。 


1.1.4 纳米 技术 


纳米 技术 是 一 种 通用 技术 ， 目 前 对 许多 工业 应 用 都 非常 重要 ， 它 保持 了 技术 
革命 进步 的 新 趋势 。 按 马克 欧文 ( 1996 年 ) 的 说 法 ， 纳 米 技术 可 以 被 定义 为 对 
材料 、 设 备 和 系统 的 研究 、 发 展 和 处 理工 艺 。 要 获得 必要 的 功能 特性 ， 必 须 有 一 
个 小 于 100nm 的 结构 。 它 包括 纳米 制造 工艺 、 设 计 、 纳 米 结 构 的 行为 和 模型 、 
纳米 规模 的 测量 方法 和 表征 。 纳 米 技术 可 以 视 为 是 迈 向 精密 工程 的 必然 一 步 ， 通 
过 超 精 密 加 工 的 进展 ， 准 确 性 从 微米 级 将 进入 纳米 级 。 

纳米 技术 为 技术 发 展 和 应 用 创造 了 机 会 。 这 些 机 会 产生 于 微 系 统 、 纳 米 科 学 
和 纳米 技术 中 的 纳米 科学 与 工程 研究 的 基础 ， 从 微观 系统 到 纳米 级 系统 这 一 广泛 
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领域 的 主要 发 展 动力 有 : 

1) 新 产品 的 尺寸 非常 小 ， 或 可 以 超 精密 运转 。 

2) 更 高 的 系统 性 能 。 

3) 出 于 “更 小 、 更 快 、 更 便宜 ”理念 的 小 型 化 。 

4) 更 高 的 可 靠 性 以 及 更 低 的 成 本 。 

纳米 技术 一 词 是 由 纪 夫 谷口 教授 原 就 职 于 东京 科技 大 学 ) 于 1974 FER 
京 举行 的 生产 工程 国际 会 议 上 首次 使 用 的 。 纪 夫 谷 口 特别 采用 了 纳米 技术 一 词 介 
绍 精密 加 工 中 使 用 超声 波 加 工 将 材料 加 工 至 纳米 尺度 的 精度 。 纪 夫 谷 口 教 授 随 后 
深入 参与 到 纳米 制造 的 电子 束 的 研究 与 应 用 中 。 

纪 夫 谷口 虽然 第 一 个 创造 出 这 个 术语 ， 但 纳米 技术 的 概念 可 以 说 是 首次 由 美 
国 物 理学 家 理 查 德 . 费 曼 博 士 进行 了 外 述 ， 他 于 1959 年 在 美国 物理 协会 年 度 会 
议 上 发 表 了 一 个 富有 远见 的 演讲 。 他 的 演讲 主题 为 “在 底部 有 足够 的 空间 ”， 对 
空间 的 传统 观念 提出 了 质疑 。 首 先 他 问 道 “ 为 什么 我 们 不 能 在 引 脚 / 管 脚 头 上 写 
进 整 个 24 卷 大 英 百科 全 书 ?"。 他 的 理由 是 ， 如 果 引 脚 头 上 可 放大 25 000K, K 
区 域 就 足以 包含 所 有 页 码 的 大 英 百科 全 书 。 这 放大 率 将 等 同 于 缩小 所 有 书页 内 容 
25 000 次 。 他 当时 还 预测 说 ,扫描 电 子 显微镜 (SEMI) 可 改善 分 辨 率 和 稳定 性 ， 
能 够 分 解 原子 。 他 接着 进一步 预测 可 能 直接 排列 原子 建造 微小 结构 ， 从 而 进行 材 
料 的 分 子 或 原子 合成 。 现 在 来 看 ， 他 的 预见 和 预测 是 非常 准确 的 。 他 虽 没 有 明确 
使 用 纳米 技术 一 词 ， 却 准确 地 预测 了 纳米 技术 的 潜力 和 应 用 。 

毫 无 疑问 ， 现 在 的 纳米 科学 和 纳米 技术 的 研究 和 开发 会 带 来 许多 新 的 和 令 人 
感 兴趣 的 技术 进步 和 产品 。 随 之 而 来 的 产品 小 型 化 的 浪潮 将 见证 现 有 的 宏观 产品 
被 改变 为 微 系统 科技 (MST) 和 纳米 技术 产品 。 纳 米 技术 是 一 项 重大 的 新 的 技术 
力量 ， 在 世界 范围 内 ， 将 对 社会 经 济 产生 实质 性 的 影响 ， 我 们 可 以 满怀 信心 地 期 
待 纳米 技术 给 我 们 的 生活 带 来 更 多 的 改善 。 


12 精密 机 械 和 工具 


为 了 实施 和 使 用 前 几 节 介绍 的 先进 技术 和 工艺 ， 需 要 超 精密 机 械 和 仪器 来 控 
制 “ 工 具 ” 的 三 维 空间 关系 ， 以 达到 加 工 误差 不 到 0. Inm 的 精确 度 。 这 些 工具 
可 以 是 : 

1) 切割 、 磨 料 或 化 学 机 械 作用 的 固体 工具 。 

2) 能 量 光 束 工具 。 

3) 扫描 探 针 工 具 ， 例 如 STM、AFM， 磁 、 热 或 化 学 反应 的 探 针 等 。 
超 精密 机 床 系统 一 般 分 为 三 个 主要 类 别 : 

1) 计算 机 数字 控制 (CNC) 大 型 机 床 ， 用 于 测量 、 塑 造 或 成 型 传统 的 大 部 
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件 ， 今 天 的 精密 机 械 和 工具 意味 着 能 将 大 组 件 加 工 至 纳米 公差 的 精度 。 
2) 大 型 和 微型 的 组 件 计量 应 用 的 仪器 。 
3) 针对 只 有 几 毫 米 到 微米 尺寸 的 专用 机 械 。 


1.3 精密 运动 控制 系统 的 应 用 


以 下 简要 介绍 精密 运动 控制 系统 相关 产业 和 应 用 。 
(1) 半导体 领域 

1) 光 刻 。 

2) 衬 底 涂 层 。 

3) 内 存 维修 。 

4) 激光 直 写 。 

5) 显微镜 XY 检验 。 

6) 唱片 探查 。 

7) 线 焊 。 

(2) 磁性 和 光 存 储 器 制造 领域 
1) 磁盘 驱动 器 的 读 / 写 头 加 工 。 
2) 磁盘 和 头 部 检查 。 

3) 空气 轴承 旋转 支撑 。 

4) 光盘 母 带 。 

5) 精密 磨 前 、 切 割 和 切片 。 
6) 磁带 头 加 工 。 

7) 飞升 高 度 的 测试 。 

(3) 光学 制造 领域 

1) 透镜 和 金刚 石 镜 面 车 床 。 
2) 光学 磨床 。 

3) 精密 旋转 式 扫描 仪 。 

4) 钻石 快速 切削 车 床 。 

5) 隐形 眼镜 镜片 车 床 。 

6) 编码 器 和 光栅 刻 线 机 。 
(4) 高 分 辨 率 成 像 领域 

1) 平板 显示 器 。 

2) 内 外 滚 简 绘 图 机 。 

3) 恒定 速度 运动 。 

(5) 精密 计量 领域 
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1) 亚 微米 坐标 测量 仪 。 

2) 平整 度 和 圆 度 测 量 系统 。 

3) 视觉 和 光学 检测 。 

4) 汽车 、 医 疗 、 电 子 、 光 学 元 件 。 


1.4 本 书 的 范围 


本 书 的 内 容 主要 集中 于 实现 精密 运动 定位 系统 的 控制 系统 和 仪器 仪表 技术 。 
这 些 技术 将 解决 设计 精密 运动 控制 系统 的 几 个 重要 的 挑战 ， 包 括 运动 控制 算法 、 
几何 误差 补偿 、 编 码 插值 、 机 械 振 动 监测 与 控制 ， 以 及 其 他 相关 工程 问题 。 这 是 
一 个 重大 成 果 和 出 版 物 的 汇编 ， 来 源 于 作者 已 着 手 开发 的 一 个 非常 先进 的 高 速 超 
精密 的 机 器 人 系统 项 目 。 该 书 全 面 和 完整 地 讨论 了 这 一 主题 ， 符 合 广大 读者 群 的 
基本 要 求 ， 通 过 提供 详细 的 开发 试验 材料 验证 ， 既 考虑 了 进行 学 术 研 究 的 读者 的 
要 求 ， 也 考虑 实际 应 用 的 读者 要 求 。 考 虑 到 本 书 的 完整 性 ， 本 书 也 提供 了 有 关 精 
度 控制 系统 设计 工程 方面 的 内 容 ， 这 些 内 容 对 确保 整个 系统 的 最 终 成 功 是 非常 重 
要 的 。 


第 2 章 精密 跟踪 运动 控制 


在 本 章 中 ， 将 介绍 系统 常 使 用 的 压 电 磁铁 和 永 磁 直 线 电动 机 的 精密 驱动 器 。 
它们 的 数学 模型 和 控制 方案 也 将 在 本 章 中 进行 介绍 。 


2.1 压 电 驱动 器 


在 微 纳米 系统 的 领域 ， 压 电 驱 动 器 (PA) 作为 一 个 精密 的 驱动 器 ， 已 经 是 
越 来 越 受 欢 迎 的 选择 。 由 于 它 能 够 实现 高 精度 和 多 功能 性 ， 得 到 了 广泛 的 驱动 应 
用 。 更 具体 地 说 ; PA 可 以 提供 非常 精确 的 定位 (纳米 级 )， 并 产生 高 值 力 ( 高 
达 数 千 牛 顿 )。PA 得 到 了 日 益 广泛 的 工业 应 用 ， 在 各 种 光纤 校准 、 校 准 掩 码 和 
医疗 微 操纵 系统 中 PA 应 用 的 作用 是 非常 突出 的 。 

尽管 PA 在 这 些 应 用 领域 的 应 用 广泛 ,但 设计 和 控制 这 些 设备 仍 具有 挑战 
性 。 下 面 详细 介绍 PA 设计 和 控制 的 有 关 问 题 。 


2.1.1 压 电 驱动 器 配置 的 类 型 


在 纳米 解决 方案 和 高 速 应 用 中 ，PA 提供 了 独特 ; = $ 


的 和 令 人 信服 的 优势 。 为 了 获得 PA 最 大 的 性 能 ， 采 
用 不 同 的 配置 和 设计 ， 以 满足 各 种 要 求 。 

1. BMI 

最 常见 的 PA 设计 是 -一 个 陶瓷 至 层 ， 层 春 式 驱动 
器 的 结构 如 图 2. 1 所 示 。 这 种 装置 能 够 实现 高 性 能 位 
移 和 控制 力 。 可 用 的 商业 产品 标准 设计 承受 压力 可 达 上 一 
100kN (如 Physik Instrument 公司 产品 ) ， 并 且 预 装载 0 
驱动 器 也 可 以 按 推 挽 模 式 运行 。 图 2.1 层 普 式 驱动 器 的 结构 

2. Bitit 

这 种 设计 采用 了 超 薄 层 状 陶瓷 片 ， 层 状 设计 结构 如 图 2. 2 所 示 。 当 电压 施加 于 设 
备 ， 驱 动 器 陶瓷 片 收 缩 。 设 备 位 移 在 材料 垂直 的 极 化 和 电场 应 用 的 收缩 方向 产生 。 层 
状 驱动 器 运行 的 最 大 值 是 一 个 片 长 度 的 函数 ， 而 薄片 并 行 排列 的 数目 将 决定 陶瓷 单 
元 的 刚度 和 产生 的 力 。 层 状 驱动 器 很 容易 集成 在 传统 的 复合 材料 层 中 。 

3. 管状 设计 

整体 陶瓷 管 是 压 电 驱动 器 的 另 一 种 形式 。 图 2. 3 所 示 为 管状 设计 结构 。 管 表 
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面 分 割 成 四 个 区 域 ， 它 们 沿 着 管 的 一 端 与 电极 连接 在 一 起 。 因 此 ， 就 可 以 由 电压 
管 发 起 不 同 的 运动 方向 。 例 如 ， 当 电压 作用 于 薄 壁 管 的 外 部 和 内 径 之 间 ， 管 沿 轴 
向 和 径 向 收缩 。 陶 次 管 在 各 种 不 同化 学 和 材料 加 工 过 程 中 得 到 了 应 用 。 陶 瓷 管 也 
可 用 来 制造 高 电压 或 功率 应 用 的 零件 ， 如 绝缘 体 、 点 火 或 加 热 元 件 。 





EN 二 








图 2.2 层 状 设计 结构 


4. 摆 转 设计 

摆 转 设计 采用 了 压 电 圆柱 体 由 LPZT ( Ba 
AMR) 陶瓷 径 向 极 化 。 局 部 转动 驱动 器 的 构造 如 
图 2.4 所 示 ， 压 电 简 2 安装 在 一 个 刚性 基 座 1 
上 。 压 电 简 在 自由 端的 运动 传 到 摩擦 垫 3 Eo m 
簧 4 提供 了 一 个 法 向 力 反 抗 摩擦 垫 产生 的 摩擦 
力 。 制 动 件 5 和 棒 6 作为 旋转 轴 起 作用 。 

驱动 器 的 设计 基于 间接 驱动 模式 ， 因 此 减少 
了 驱动 器 输出 迟滞 的 影响 。 压 电 简 的 外 表面 分 成 





几 段 。 本 设计 中 使 用 了 四 段 ， 但 如 果 期 待 更 好 的 a 
解决 方案 ， 段 的 数目 可 以 增加 。 内 表面 是 一 种 党 Breer y 
见 的 电 接触 点 。 图 2.4 局 部 转动 驱动 器 的 构造 


1 一 刚性 基 座 2 一 上 讨 电 得 ”3 一 摩擦 热 
利用 这 一 构造 ， 电 压 作用 到 特殊 段 时 将 扩大 aR 5_ 制 动 件 oi 


简 的 不 平衡 。 通 过 应 用 电压 以 被 控 方 式 有 序 跨越 

邻近 节 ( 即 记 ，V 等 )， 不 完整 的 旋转 波 可 以 产生 于 压 电 简 的 一 端 ， 准 备 传 给 安 
装 在 筒 顶部 的 摩 氛 盘 。 要 变换 旋转 的 方向 ， 可 以 将 负电 压 作用 到 各 段 。 通 过 控制 
应 用 正 负 电压 时 间 的 长 短 ， 可 以 控制 电动 机 的 转角 。 


2.1.2 数学 模型 
在 本 节 中 ， 将 介绍 线性 和 摆 转 压 电 驱动 器 动态 特性 。 压 电 设计 可 用 于 线性 或 
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摆 转 应 用 。 动 态 模 型 来 自 于 系统 的 物理 特性 ， 包 括 它 的 压 电 效应 结构 和 压 电 元 件 
的 构造 。 
1. 线性 压 电 驱动 器 PA 系统 
这 里 考虑 的 线性 系统 是 基于 压 电 去 堆 的 对 象 。 分 析 可 由 压 电 性 的 本 质 方程 开 
始 ， 其 次 是 力 的 产生 ， 然 后 物体 的 移动 。 
考虑 压 电 效应 ， 得 到 本 质 方程 如 下 : 
Tj = Cusk -Ew V, (2.1) 
D; =ewsu + GV, (2.2) 
LH, oAMAKE; s 为 应 变 矢 量 ; 了 为 电场 矢量 ; D 为 电动 位 移 和 拓 量 ; e 为 弹 
性 刚度 常数 矩阵 ; e ATER BUERE, «AT RRR; Lip EAS 分 别 
指 恒定 电场 和 恒定 应 变 
线性 压 电 驱 动 器 的 推动 力 是 靠 压 电 闭 堆 简 产生 的 ， 每 层 施 加 了 力 已 。 考 虑 
BFE BEANE, RHE PR A (Goldfarb) 和 塞 拉 诺 维 克 ( Celanovic ) 
(1997 年 ) 的 文献 ， 驱 动力 可 以 表示 如 下 
人 =x) Ikl- a)l <f, 


lfsgn(%) 其 余 


F, = XF, (2.4) 

AF, k ARIE; x 为 位 置 ; x, 为 块 位 置 ; j 为 分 裂 力 ，index(. ); BEN f 
一 层 。 

2. 摆 转 压 电 驱动 器 系统 

下 面 介绍 摆 转 压 电 驱动 系统 的 动态 性 能 ， 分 析 包 括 压 电 效应 和 外 部 弹簧 效 
应 。 以 类 似 的 方式 分 析 了 压 电 效应 ， 如 式 (2.1) MA (2.2) 对 线性 系统 的 
解释 。 

这 种 摆 转 系统 已 用 于 卵细胞 穿孔 内 部 细胞 质 注射 精子 。 系 统 的 详细 情 
如 下 : 

由 于 弹簧 力 压 下 电动 机 ， 轴 向 负荷 出 现在 简 内 。 简 可 以 视 为 管 。 

以 下 方程 被 应 用 : 


(2.3) 


F, =k y, (2.5) 
AF, F, 为 弹簧 力 ; k, 为 弹簧 常数 ; y, 为 弹簧 位 移 。 
压缩 力 在 控制 之 下 ， 因 为 弹簧 位 置 * 是 可 调节 的 。 弹 得 常数 取决 于 弹 得 
类 型 。 
由 于 轴 向 压力 ， 弹 短 力 导致 简 收 缩 
F, ky, 
Om = = (2.6) 


= A 1 
= grh - di) 
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式 中 ，ow 为 轴 向 应 力 (由 于 轴 向 力 的 应 力 ); Aa NER; d, Ad, 分 别 是 简 的 
内 、 外 直径 ， 并 且 应 变 为 


_o(ax) _ ky, 





= (2.7) 
oink (a -d) 
式 中 ，s。 为 轴 向 应 变 ; E 为 弹性 模 量 。 
假定 压 电 人 简 只 在 其 弹性 限制 内 载荷 ， 轴 向 位 移 可 以 公式 化 为 
O ax 
Yar SaL = Et 
L ky, 
=I (2.8) 
an d; 一 di ) 
微分 分 析 可 用 来 分 析 位 移 。 简 坐标 系 的 位 置 表达 如 下 : 
dr =rdr + drdd + zdz (2.9) 


HOLE URN ARMS HME. ERE, BE 
7， 中 和 :方向 变形 。 沿 > 和 :方向 的 变形 被 忽视 ， 因 为 它们 对 电动 机 旋转 没有 
帮助 。 
电场 用 于 方程 (2. 1) 如下: 

=- 二 (2. 10) 
因为 电压 作用 于 它 的 厚度 ， 其 中 U 是 电压 ，r, 和 分 别 是 内 、 外 半径 。 电 压 是 
沿 方 向 作用 ， 或 等 值 的 1 方向 ， 而 位 移 是 沿 由 方向 运动 。 因 此 ， 第 c21 号 和 
e21 常量 将 被 使 用 。 

由 方程 (2. 1) ， 同 时 考虑 到 ， 没 有 任何 附加 力 /压力 作用 于 简 





cos -€ V =0 (2.11) 
根据 方程 (2. 11) ， 切 向 应 变 为 
21 U Ox, 
bon (2. 12) ae - 
由 切线 方向 应 变 定 义 
_ _n6b 
s, = 54 = rd (2.13) 
6x, =1, 5 = sır dh (2.14) 





压 电 单元 的 弯曲 如 图 2. 5 所 示 。 
以 上 所 描述 的 轴 向 位 移 伴 随 切 向 弯曲 变形 位 移 。6y。 7 
的 数值 直接 相当 于 ôx, RRE. A SKL, A 25 压 电 单 元 的 弯曲 
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可 以 假设 sg。 和 dy, 作为 正 交 位 移 ，L 为 半径 ， 得 到 
dy, =L- VL - (8x,)’ (2. 15) 
WE (2.15) 表示 的 结果 类 似 压力 分 布 。5y, 的 数值 相当 于 法 向 力 在 定子 和 转子 
之 间 产 生 的 摩擦 力 。 
旋转 的 数值 和 动力 学 方程 取决 于 电动 机 标准 
力 ， 这 又 取决 于 By,。 根 据 方程 (2.15) 法 向 力 的 
分 布 情况 如 图 2.6 所 示 。 
沿 轴线 方向 的 总 位 移 是 轴 向 和 弯曲 变形 的 和 
by = B74 + Va, (2. 16) 
可 以 假定 橡胶 盘 足 够 硬 ， 这 样 才 不 会 产生 塑性 区 变 。 图 2.6 法 向 力 的 分 布 情况 
形 。 根 据 这 一 假设 ， 橡 胶 盘 应 变 如 下 


g7 (2.17) 


如 果 s,, 是 橡胶 应 变 ，5y EAMA, LARRABEE. BE, HARRE 
应 力 如 下 : 








Opn = E48, (2. 18) 
这 里 ,是 橡胶 的 弹性 模 量 ,并且 ;,, 是 橡胶 的 压力 。 
压力 的 分 布 由 方程 (2.18) 获得 ， 修 改 方程 (2.15) WF: 


ys=L- VL -ngs (2. 19) 

造成 的 压力 分 布 
_ En 2242.2 2.20 
CH= (Yt L -rg sz (2.20) 


这 种 压力 产生 摩擦 力 ， 于 是 
dF =yo,,dA =po,dr dy 


E, 
=W; T, (Yæ +L- VD -ngs)drdy, (2.21) 


Eoia 
Faw TAPE asr- (PRED) 2) 
运动 方程 从 旋转 刚体 的 基本 方程 导出 
六 中 = Fr, (2. 23) 


其 中 ， 是 转子 的 转动 惯量 和 F 是 定子 的 摩擦 力 。 转 动 惯量 的 转子 的 计算 方式 
是 只 考虑 转子 金属 部 分 ， 因 为 摩擦 垫 的 质量 很 小 ， 所 以 忽略 了 摩擦 热 的 转动 
惯量 。 

在 很 短 的 时 间 内 Cf 冲击 力作 为 一 个 脉冲 力 处 理 ) 的 积分 方程 (2.23) 中 ， 
力作 用 后 的 瞬时 角速度 如 下 : 
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Indy = Fr;. (2. 24) 
阻碍 这 个 运动 是 轴 和 转子 之 间 的 摩擦 力 ， 这 里 弹簧 力 提供 了 法 向 力 ， 克 服 了 
摩 氛 垫 和 定子 之 间 的 摩擦 力 ， 最 初 引起 该 转子 运动 。 可 以 公式 化 如 下 
Ip =F 7, + pF 1; 5 (2.25) 
RP, ur 为 转子 的 摩擦 系数 ，r, 为 接触 轴 的 平均 半径 。 
由 方程 (2. 24) 得 到 w。 = $o。 根 据 方程 (2.25) 和 a = 中 ， 运 动 方程 可 以 构造 如 
下 


a(t) = 由 (2.26) 
w(t) =wo -at (2. 27) 
Olt) = wot - Lor (2. 28) 


2 

3. 压 电 驱动 器 的 统一 建 模 

下 面 介绍 动 态 模型 ， 该 模型 在 压 电 驱动 器 PA 的 模拟 、 预 设计 和 设计 阶段 是 
有 用 的 。 它 允许 快速 的 性 能 核查 和 预测 。 然 而 ， 对 于 控制 设计 的 目的 ， 一 般 模 型 
将 更 加 适用 。 本 节 给 出 了 一 般 线 性 和 摆 转 的 压 电 驱动 器 PA 模型 。 对 模型 一 些 性 
质 进行 了 讨论 。 

电压 可 控 压 电 驱 动 器 PA 系统 的 数学 模型 可 以 用 下 列 微分 方程 近似 的 描述 

mi = —K,x-K,x+K,(u(t) -F), (2.29) 

式 中 ,u(t) 为 随时 间 变 化 的 电动 机 端子 电压 ; x( 为 压 电 位 置 ; Kj 为 电动 机 产 
生 的 阻尼 系数 ; K, 为 机 械 刚度 ; K, 为 输入 控制 系数 ;m 为 有 效 质 量 ; FF 为 系统 
的 非 线 性 干扰 。 

众所周知 ， 压 电 驱 动 器 PA 的 主要 干扰 是 迟滞 现象 。 图 2. 7 所 示 为 存在 于 线 
性 压 电 致 动 器 的 一 个 典型 的 迟滞 现象 。 这 个 迟滞 幅度 可 以 在 运动 的 约 10% ~15% 
范围 内 形成 。 迟 灌 普 遍 阻 碍 高 精度 运动 ， 因 而 迟滞 分 析 是 实现 高 性 能 压 电 驱动 器 
PA 系统 的 关键 。 正 如 Gilles 等 人 (2001 Æ) 所 阐述 的 那样 ， 述 滞 是 类 摩擦 现 
象 。Canudas-de-Wit 等 人 (1995 Æ) 从 摩擦 力 导 出 了 一 个 复杂 的 动态 摩 接 模型 。 
由 此 建立 的 模型 显示 了 摩擦 现象 的 主要 特点 一 一 迟滞 、 摩 擦 滞后 、 变 化 的 突破 力 
和 粘 滑 的 运动 。 模 型 很 全 面 足以 捕捉 动态 滞后 效应 。 这 种 动态 摩擦 模型 的 数学 方 
程 如 下 





F=o,z+0, z+0,% (2. 30) 


具有 
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位 移 m 





° 电压 /V 
图 2.7 线性 压 电 致 动 器 的 迟滞 现象 


oF.+(F,-F.)e H 
h(x) = z 
0 


Hp, Fo, Fy, X., Oo, 01, 0, 是 正常 数 ， 通 常 是 未 知 的 。 非 线性 函数 下 也 可 
以 写作 为 





F=(0,+0,)% +aoz 一 Cl Jal ig, +05) 2 4+F (2, x) (2.31) 


YE ) 
第 一 部 分 〈c to) AAE RR, PERAR, BR 


(oo - 2 是 z 的 函数 。 因 此 z A (x) OA 








IF ,(z,%)| = (a - 
HF, k 和 是 常数 。 
2.1.3 自 适应 控制 


在 本 节 中 ， 基 于 方程 (2.29) 的 一 般 模 型 设计 了 一 个 自 适 应 控制 器 。 针 对 
建 模 的 不 确定 性 ， 该 控制 器 具有 和 鲁 棒 性 。 

考虑 方程 (2.29) 的 系统 。 跟 踪 控 制 目标 说 明 如 下 : 找到 一 种 控制 机 制 ， 
对 于 每 一 个 有 界 平滑 输出 参考 x,(1) ， 具 有 有 界 时 间 导 数 ， 使 得 有 关 控 制 的 输出 
a(t) RU] REARS x(t), A x, Mx,, ta 是 连续 适用 的 ， 并 且 
有 界 。 

定义 位 置 跟踪 误差 e(t) 和 相应 的 滤波 跟踪 误差 s(t) 如 下 

e(t) =x,(t) -x(t) (2. 33) 


a 


hay J7 Shi tal (2. 32) 


并 且 误 差 
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s = K,[e(r)dr + Ke +è (2.34) 
REK, K,>0, AK, K, 使 这 个 多 项 式 + Ks +K ERE? (Hurwitz) 
多 项 式 。 区 别 s(i) 并 利用 等 式 (2.29), THER SCO SSIES 


K, 
人 (Kie +K, TERES: Kate C F) 


. K . 
=y (Ke +K, e +4) (Kto ZA 


+ RE ut PCa) (2.35) 
通过 使 用 简单 精确 模型 的 知识 ， 可 以 定义 一 个 控制 输入 为 
wu=K,sta,(Kie+K,e +%a) +a% +4,,.%+F, (2. 36) 


其 中 K, >0 是 一 个 常数 ，a = Zs Oy =R to to HE ay -= 
HR (2.36) 控制 输入 代入 方程 《2.29) 的 开 环 表达 式 ， asia TnL 
BRD, Mi = -Ks HFK >0, AEN REMEBER. WERE, 
SIRIORAESRR AI, MSh, ERATE m, Ky Ky, K, MIAGE, H 
FA, AERA MTU, +o ton KAR 
有 2. ，2 ,2 估计 及 sen(s) + 名 1z1sgn(7) 的 Fa, 分 别 设计 如 下 


u=K,s+a,(Ke+K, ¢+%,) +t 


+ 人 二 和 sen(s) +h, lx lsgn(s) (2. 37) 
将 方程 (2. 37) 中 的 控制 代入 式 (2.35)， 有 
KS = -Kyr+@,(Ke+K, täy) + dit FX 

—h,sgn(s) —k,lxlsgn(s) +F, (2. 38) 

其 中 ， n =K dn By, ETETE P 

自 适 应 律 选 择 如 下 

ån =y;( (Ke +K, @+%,)3 -Y ân] (2.39) 
åm =yalžs -Ya Aig | (2. 40) 
åp = Ya[ xs — Yq, Age] (2.41) 


ki =y,[ ls! -yh ] (2. 42) 
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=y,[ lells! -ysk,] (2. 43) 
其 中 ， Yis Yn» Yor Yn» Va Yas Yas Ya» Ys» Ys >0。 
1. 稳定 性 分 析 
稳定 性 分 析 结 果 建 立 如 下 。 


定理 2.1 考虑 方程 (2.29) 的 对 象 和 跟踪 期 望 轨迹 xs，xs，zi 的 控制 目 
标 。 由 方程 (2.39) ~ 方程 (2.43) 提供 的 控制 律 式 (2. 37) 确保 系统 状态 和 
参数 是 一 致 有 界 。 


证 明 : 取 正 定 函 数 
Imo, l -212 1 22 l s2 1 >72 
va) =+ Ze +a} +a +E FE2 (2.44) 
2 KS yy ty rtm y l 


Ht, isk -k,, k,=k,-h,, EMM SHH 
Va -Ks +[G@,(Ke+K, e+%,)+@,,%+ Gx]s 
+[ ~k,sgn(r) -k, 1% lsgn(r) +F,]s 


1 ~ la ~ 1 ~ z 
+—a4, @4,+—4,,4,,+—@,,4,,+ 


m 


Yı Y2 T y E E Y Ys 
在 方程 (2. 32) 中 使 用 不 等 式 ， 表 示 如 下 


Vs -Ks +[@,(Ke+K,é+%,)+%,,%+G,2]s+ hilrl + 大 2 元 11s| 
1 : 1 ~ ~ leo ~ 1 > ~ lero 
+—@, 4@,+—a,4,+—4,4,+—kh,k,+—k,k 2. 46 
yı pie ety e ety hi tyt k (246) 
自 适应 律 代 人 到 上 述 公 式 ， 可 以 得 出 


kk, (2.45) 


. 2 aa ~ A ~ A 
Vs -K s +Yn 4,4, + Yn @ G ighig + Ya T ge ge + Yu ki ky + Ys kak 


-Kig uez -l z -lg P 
= 一 天 |s tK,» 2 + 天 《Gu 7 Ate) 
~ 1 
+m 1. \2 +e +t) y2 Yu a? _ Yar a? 
_7 Y rf 
r, a-g 4l 4K AK (2.47) 


这 保证 了 任何 Rote 






9 
a Yu a Ya a? Yai ie Y51 k 
4K, ” 4K, Phe “AK, Tee ~ aK" “4K, 





(2.48) 





O ” 式 (2.48) 中 的 六 个 公式 根 号 内 减 号 应 为 加 号 , 原 书 有 误 。 一 一 译 者 注 
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~ l 2 Ya 2 Ya 2 Ya, Ys 72 
lanl > fa, -oo 一 a. 一 ki 一 ky +a, 
4 4y11 i 471 © 4yu ' 4Yy1 ” 2 


~ Yu 2 1 o Ya 2 Ya 2 Ysi 2 1 
ia,,| > |e- 4 O ko Aa Age 一 4y, i 4Yyz kz +5 Big 


















am 一 Tig — Ege 一 
4Yya 473: ww 48 4ya | 4ya 


Yu a Y21 2 Yan 2 l2 A 2 
k, _ 732 a 
| k, | > [ee a CAN E Ay, Tho ~ 4 ae 41-4 Ay," $k, 


Yu 2 Ya 2 Y31 2 Ya 72 2 
| k, | > a, OL, 一 a. 一 k -LE +lk 
[ee ays; to 475 © 4ys 1 4? 2? 


Yu 2 Yn 2 1 2 Yu, Ys EENEN i 
wale 二 2 Al Lag 




















Ait, s, @,, a, a,, ki, k, 最 终 是 一 至 有 界 的 。1s1 值 可 通过 增加 
变 小 。 

2. 试验 结果 

对 于 线性 压 电 驱动 器 PA, WJH Physik Instrumente (PI) 公司 制造 的 一 个 直 
流 伺 服 电动 机 ， 它 具有 80pm 的 运行 长 度 ， 并 装备 了 一 个 线性 位 移 变 量 转 换 
(LVDT) 的 传感器 ， 有 效 精度 达到 Snm。 使 用 了 dSPACE 实时 控制 的 开发 和 快速 
原型 平台 。 在 dSPACE 的 环境 下 应 用 MATLAB®/Simulink® 。 分 别 由 模拟 输入 和 数 
字 输 入 及 dSPACE 卡 ， 将 位 置 和 开关 信号 反馈 到 控制 系统 。 轨 迹 模型 被 转发 到 自 
适应 控制 器 作为 参考 信和 号， 然后 控制 器 的 输出 被 发 送 到 压 电 驱动 器 。 运 行 
MATLABS 的 实时 视窗 可 实现 系统 控制 。 

控制 系统 设计 的 关键 作用 之 一 就 是 建立 一 个 模型 。 为 了 建立 模型 ， 首先 要 从 
压 电 驱动 器 系统 收集 试验 数据 。 线 性 调频 信和 号 用 于 模型 识别 。 选 择 模 拟 输出 通道 
1， 将 信和 号 发 送 到 压 电 电动 机 。 采 样 频率 选择 为 2000Hz， 并 且 调 频 信 号 的 频率 选 
定 为 0 ~200Hz 的 范围 。 主 线性 模型 为 

% = -1081.6 x -5.9785 x105x +4. 2931 x 10%u 

该 模型 给 出 了 线性 压 电 驱动 器 PA ARM, ERARE, IRF 

自 适 应 控制 器 应 用 到 压 电 驱动 器 PA。 该 控制 器 的 参数 选 为 

K, =0. 00001 K, =400 000 K, = 100 (2. 49) 

Any Byes Cg DEEPER LA SEF EPA, “Eile, (0) =2. 3293 x 
0-7, G,,(0) =2. 5194 x10-*#la,,(0) =0. 1184。 初 始 值 和 Ak, 分 别 选 为 10 和 
107, PAK, BL taza AN ft RRA BS PA BD, 
的 内 子 被 使 用 ， 选择 Yi EV EZY: = 107”, Ya “Ys = 107”, Yu F Yan F Ya 5 Ya = 
ys, =0. 0001, 
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跟踪 参考 信号 是 Asin( wt) ， 其 中 4 =3um, w =6rad/s。 该 控制 器 的 实际 响应 
如 图 2. 8 所 示 。 可 以 观察 到 ， 根 据 既 定 的 控制 ， 实 际 响应 正弦 轨迹 是 好 的 。 跟 踪 
误差 约 0.3km。 据 观察 ， 按 照 既 定 的 自 适 应 控制 ， 可 以 达到 微观 层面 的 高 精确 
度 控制 。 如 果 只 使 用 该 控制 器 的 PID 控制 组 件 ， 结 果 如 图 2.9 所 示 ， 跟 踪 误 差 约 
为 1.0hm。 这 表明 自 适 应 控制 器 可 以 实现 优 于 PID 控制 的 跟踪 性 能 。 


5 


实际 响应 /hm 


i 
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图 2.8 使 用 控制 方案 的 正弦 波 响 应 
5 
£ 
= 
a 
= 0 
if 
-5 L 1 u 1 1 1 m 
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E 1 
= 
w 
ok 0 
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ey a 4 1 1 
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0 
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图 2.9 只 使 用 PID 控制 组 件 的 正弦 波 响应 
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2.2 永 磁 直线 电动 机 (PMLM ) 


在 电动 机 的 驱动 中 ， 永 磁 直 线 电动 机 (PMLM) 可 能 是 高 速 、 高 精密 运动 控 
制 中 最 自然 的 应 用 。 在 半导体 工艺 ， 精 密 测 量 和 微 系 统 装 配 中 ，PMLM 得 到 日 益 
广泛 的 工业 应 用 。 这 些 应 用 过 程 中 的 高 性 能 要 求 验证 了 PMLM 的 显著 效能 。PM- 
LM 的 主要 优点 包括 可 以 实现 高 密度 力 、 低 热 损耗 ， 最 重要 的 是 精准 度 高 ， 与 其 
相关 的 机 械 结构 简单 。PMLM 设计 成 切割 并 展开 相对 旋转 对 应 体 部 分 ， 与 图 解 过 
程 完全 相似 ， 沿 径 向 平面 切割 普通 电动 机 旋转 电 酌 和 旋转 定子 ， 展 开 为 平面 ， 如 
图 2. 10 所 示 。 其 结果 是 一 个 平面 直线 电动 机 产生 线性 力 ， 而 不 是 扭矩 ， 由 于 旋 
转轴 不 再 存在 。 电 磁 旋 转 电动 机 转 矩 产生 的 同一 力 直 接 用 于 产生 直线 电动 机 的 线 
性 力 。 相 对 于 异步 直线 感应 电动 机 ，PMLM 采用 稀土 永 磁体 具有 非常 高 的 磁 通 量 
密度 ， 并 能 开发 出 更 高 的 磁 通 量 密度 ， 而 不 产生 热 。 不 同 于 旋转 机 械 ， 直 线 电动 
机 不 需要 齿轮 箱 ， 链 条 和 螺丝 耦合 等 间接 耦 合 机 构 。 这 大 大 减少 了 非 线性 接触 效 
应 和 干扰 ， 如 反弹 和 摩擦 力 ， 尤 其 是 当 它们 使 用 静 压 或 磁 轴 承 时 。 然 而 ,使 用 机 
械 传动 的 优点 也 从 而 丧失 ， 如 减少 模型 不 确定 性 和 外 部 干扰 影响 固有 能 力 。 因 
此 ， 通 过 适当 的 物理 设计 或 通过 系统 控制 减少 这 些 影响 是 最 重要 的 ， 特 别 是 在 实 
现 高 速 、 高 精度 运动 控制 的 情况 下 。 





图 2. 10 展开 一 个 旋转 电动 机 
下 面 介 绍 各 种 能 够 进行 精确 的 PMLM 运动 跟踪 控制 方案 。 
2.2.1 PMLM 的 类 型 


直线 电动 机 最 初 的 几 个 专利 可 以 追 湖 到 20 世纪 中 叶 。 最 近 几 年 ， 直 线 电 动 
机 在 材料 和 结构 的 革新 都 到 得 了 性 能 和 成 本 的 效益 ， 扩 大 了 其 应 用 领域 。 目 前 商 
业 可 用 的 PMLM 主要 类 型 有 : 平板 直线 电动 机 、U 形 直 线 电动 机 和 管状 直线 电动 
机 。 下 面 将 简单 介绍 这 些 设计 。 

1. 平板 直线 电动 机 

平板 直线 电动 机 如 图 2. 11 所 示 ， 是 
常见 的 无 刷 直流 直线 伺服 电动 机 ， 其 投入 
应 用 已 超过 25 年 。 在 自动 机 和 机 床 的 应 
用 中 需要 极 高 的 连续 力 和 峰值 力 ， 因 此 平 图 2. 11 平板 直线 电动 机 
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板 电 动机 深 受 欢迎 。 这 些 直线 电动 机 由 两 个 主要 单元 组 成 : 移动 的 柜 箱 和 固定 压 
板 。 平 板 电 动机 将 定位 在 恰当 角度 的 定子 永 磁体 朝向 推力 轴 〈( 就 像 在 导轨 架 上 
的 枕 木 一 样 )， 但 稍 倾斜 于 牌 直 平面 ， 它 可 以 减少 推力 流动。 平板 直线 电动 机 具 
有 高 度 低 的 特点 ， 并 有 大 范围 的 尺寸 可 供 选 择 。 

通常 ， 在 柜 箱 的 线圈 中 包含 一 个 铁 忌 ， 用 以 增加 电磁 通 密度 ， 由 此 产生 了 原 
动力 输出 。 但 是 ， 由 于 存在 有 效 的 制 动 (RE) J, FERE T A 
合 运动 。 铁 芯 还 造成 涡流 损耗 ， 它 是 电动 机 速度 的 函数 。 这 种 热能 必须 有 效 地 分 
散 到 周遭 的 环境 ， 以 防止 发 动机 过 热 ， 并 避免 磁 饱 和 。 为 实现 这 一 目标 ， 强 制 有 
效 的 冷却 (采用 空气 或 水 ) 必须 严格 使 用 。 此 外 ， 柜 板 设计 中 的 磁 通 量 使 用 率 
是 次 优 的 。 线 圈 层 生成 不 属于 垂直 于 磁场 B 的 力 只 是 最 高 值 的 一 小 部 分 ; 而 平 
行 于 运动 轴 的 部 分 对 推力 输出 根本 不 作 贡 献 。 为 了 弥补 较 差 的 磁 通 量 利用 率 ， 这 
种 电动 机 吸收 更 多 的 电流 ， 将 会 导致 大 量 的 热量 损失 ， 才 能 实现 相当 于 其 他 结构 
电动 机 提供 力 的 水 平 。 力 输出 的 一 致 性 依赖 于 保持 紧密 一 致 的 空气 间隙 
(<0.5mm); 空气 间隙 的 变化 引起 运动 路 径 通 量 波动 ， 因 此 力 输 出 发 生变 化 。 
这 些 力 输 出 的 变化 必须 补偿 ， 以 保持 良好 的 轨迹 跟踪 性 能 。 柜 板 之 间 的 高 吸引 力 
要 求 精 密 的 气 隙 耦合 ， 也 导致 了 相对 复杂 的 安装 工艺 。 

2. U 形 直线 电动 机 

图 2. 12 所 示 为 男 一 种 目前 较为 常用 的 直线 电动 机 设计 一 一 U 形 直线 电动 机 。 
U 形 直线 电动 机 广泛 应 用 于 需要 高 精度 
平滑 运动 的 场合 。U 形 电动 机 的 电 枢 是 将 
平面 绕组 用 环 氧 树脂 粘 结 到 双 列 磁铁 之 
间 的 一 个 塑料 的 “刀锋 ”上 。 轨 道上 的 
永久 磁场 与 在 刀片 的 电磁 场 结 合生 产 直 
线 运动 。 这 种 设计 的 优点 是 具有 零 制 动 
力 ， 当 电 枢 和 定子 间 没 有 吸引 力 时 ， 运 动 也 是 平滑 的 。 除 了 优良 的 平滑 性 ,，U 形 
直线 电动 机 也 具有 较 好 的 成 本 效益 和 广泛 的 运行 长 度 控 制 能 力 。 因 为 刀片 和 轨道 
之 间 没 有 空气 间隙 精度 的 要 求 ，U 形 直线 电动 机 运行 长 度 可 以 很 长 。 

这 种 结构 的 缺点 之 一 是 低 的 机 械 性 传播 ， 环 氧 树脂 填充 的 电 枢 刀片 在 何 服 控 
制 高 加 速度 应 用 时 可 能 导致 共振 。U 形 的 几何 形状 会 捕获 线圈 旁边 的 热 空 气 ， 因 
此 ，U 形 直线 电动 机 只 有 通过 安装 在 电动 机 刀片 上 的 散热 片 或 强制 冷却 ， 才 能 得 
到 有 效 的 冷却 。 此 外 ，U 形 直线 电动 机 磁 通 量 利 用 效率 低下 的 特点 与 平板 直线 电 
动机 类 似 。 

3. 管状 直线 电动 机 

管状 直线 电动 机 如 图 2. 13 所 示 ， 包 括 两 个 主要 部 件 ， 有 永 磁 (通常 是 固定 
的 ) 的 推力 杆 和 包含 电动 机 线圈 (通常 是 移动 的 ) 的 推力 块 。 





图 2. 12 U 形 直线 电动 机 
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从 力 的 产生 和 能 源 效率 的 角度 来 看 ， 管 状 
直线 电动 机 比 其 他 直线 电动 机 结构 具有 重要 的 
设计 优势 。 其 器 件 由 通风 和 封装 的 单一 导电 圆 
柱 组 成 ， 包 括 电 动机 电 枢 (推力 块 ) 和 定子 
圆柱 ， 定 子 是 高 性 能 烧结 钦 铁 硼 永 磁 材 料 倒 层 
沿 N-S 轴 排 列 包装 在 管 中 。 利 用 独立 轴承 系 
统 ， 推 力 块 与 定子 之 间 通 常 隔 着 相对 较 大 气 阶 
(1mm) ， 以 支持 移动 推力 块 。 与 平板 电动 机 
类 似 ， 管 状 直 线 电 动机 在 一 个 定子 组 合 上 可 独 
立 控制 多 个 推力 块 。 图 2 13 管状 直线 电动 机 

相对 于 其 他 直线 电动 机 类 型 ， 径 向 对 称 的 管状 几何 形状 赋予 了 管状 直线 电动 
机 几 个 优势 : 所 有 与 线圈 交叉 的 磁 通 量 都 产生 推力 ; 推力 块 中 的 圆 形 绕组 与 磁 通 
模 量 在 本 质 上 是 垂直 的 ， 可 获得 最 大 线性 力 ; 对 于 一 个 给 定 的 额定 电流 和 磁场 强 
度 ， 管 状 配置 产生 的 力 高 于 其 他 效率 较 低 的 设计 ; 内 部 几何 对 称 使 磁场 均衡 ， 减 
少 了 传送 器 和 定子 之 间 的 吸引 力 。 典 型 的 管状 电动 机 中 的 吸引 力 ， 与 常规 平板 直 
线 电动 机 的 几 百 磅 力 相 比 只 有 几 磅 力 ， 高 引力 的 减少 简化 了 安装 ， 减 少 了 用 推力 
块 支撑 轴承 的 安装 要 求 ; 由 于 管状 电动 机 的 设计 中 有 较 少 的 槽 ， 它 们 的 涡流 损失 
是 微不足道 的 。 此 外 ， 推 力 块 可 作为 一 个 散热 器 ， 不 需要 强制 空气 或 液体 冷却 特 
环 ， 足 够 的 散热 使 得 连续 力 的 容量 相对 于 应 用 以 均 方 根 (RMS) 速度 不 断 提高 。 
相对 大 的 气 隙 降低 了 安装 管状 直线 电动 机 时 需要 严格 校准 的 容许 公差 。 通 过 省 略 
铁 芯 单元 ( 少 铁 设计 )， 管 状 直线 电动 机 用 力 输出 容量 降低 30% 作为 代价 ， 优 化 
了 其 运动 的 平滑 性 。 尽 管 管 状 直 线 电动 机 具有 一 些 独特 的 优势 ， 相 对 于 其 他 直线 
电动 机 ， 管 状 直线 电动 机 也 有 某 些 局 限 ， 例 如 有 限 的 运行 的 长 度 、 总 高 度 较 高 ， 
以 及 规模 和 力 的 范围 有 限 。 

圆柱 形 的 配置 带 来 的 性 能 优势 ， 也 带 来 了 某 些 尺寸 方面 的 局 限 。 由 于 定子 磁 
场 组 装 只 能 在 两 极端 得 到 支撑 ， 根 据 其 自身 的 重量 ， 疲 软 弯曲 限制 了 38mm 直径 
的 定子 行程 约 为 2500mm。 

完全 封装 的 电动 机 的 推力 块 也 导致 其 外 形 高 度 比 平板 电动 机 和 提供 侧面 安装 
的 U 形 直 线 电动 机 更 大 。 管 状 的 几何 形状 导致 管状 直线 电动 机 相对 于 其 他 直线 
电动 机 技术 ， 存 在 尺寸 有 限 和 力 的 范围 较 小 的 局 限 。 但 是 ， 设 计 方案 不 断 改进 和 
生产 成 本 的 下 降 趋 势 最 终 促进 各 种 大 小 和 力 等 级 可 用 的 管状 直线 电动 机 不 断 出 现 。 


2.2.2 数学 模型 


该 PMLM 的 动态 可 以 看 做 由 两 个 部 分 组 成 包括: 一 个 主要 线性 模型 和 一 
个 不 确定 和 非 线 性 的 余 项 (如果 高 精度 运动 控制 要 有 效 地 实现 ， 必 须 在 该 控制 
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器 的 设计 中 予以 考虑 ) 。 
在 一 个 主要 线性 模型 中 ，PMLM 机 电动 力学 可 以 表示 如 下 
Mi+Da+F,,, =F, (2. 50) 
K, +L, 9 +R, =u (2. 51) 
F,, =Kyl, (2. 52) 


其 中 ,x 表示 位 置 ; 村 ，D，F,，Fiw 分 别 表示 力学 参数 中 惯性 、 粘 性 、 产 生 的 
力 和 负载 力 ; u, L, Ro L 分 别 表示 电气 参数 中 输入 直流 电压 、 电 枢 电 流 、 电 
枢 电 阻 和 电 枢 电感 ; K 表示 电动 机 能 转换 常数 ; K, 是 反 电动 势 电动 机 常数 。 

由 于 电气 时 间 常 数 通常 远 小 于 机 械 时 间 常 数 ， 电 气 瞬 态 响 应 延迟 可 能 会 被 忽 
略 ， 提 供 简化 模型 如 下 








i Thi tt Pid (2. 53) 
其 中 

K, -SAARD y -RE (2. 54) 
显然 ， 这 是 一 个 二 阶 非 线性 动力 
学 模型 。 


主要 线性 模型 并 没有 包括 可 - 
能 会 存在 于 物理 结构 中 的 额外 的 79- [Ze 
非 线性 效应 。 其 中 ， 由 于 PMLM 
的 磁 路 结构 和 其 他 物理 缺陷 ， 波 
动 和 摩擦 力 是 两 个 突出 的 与 PMLM 
相关 的 非 线性 效应 。 图 2. 14 所 示 
为 PMLM 模型 ， 其 中 明确 包括 了 
各 种 外 在 存在 的 干扰 信号 。 图 2 14 PMLM 模型 


2.2.3 力 的 波动 


当 电 流 应 用 到 传送 器 线圈 的 永久 磁铁 时 ， 转 换 到 PMLM 传送 器 的 推力 是 靠 
两 极 之 间 一 连 串 吸引 力 和 排斥 力 产 生 的 。 除 了 产生 推力 ， 由 于 PMM 磁 结 构 ， 
PMLM 也 产生 了 一 -个 寄生 波动 力 。 这 种 波动 力 存在 于 几乎 所 有 不 同类 型 的 PMLM 
(平板 、 管 状 、 移 动 磁极 等 ) 中 ， 只 要 在 其 结构 中 铁 磁 芯 是 用 于 绕组 的 。 

这 两 个 波动 力主 要 组 成 部 分 是 齿 定 位 (或 制动器 ) 力 和 磁 阻 力 。 齿 定位 力 
的 产生 使 得 传送 器 的 磁铁 和 铁 芯 之 间 相 互 吸 引 。 这 个 齿 定位 力 在 没有 任何 绕组 电 
流 的 情况 下 也 存在 ， 它 表现 出 有 关 传 送 器 到 磁铁 相对 位 置 的 周期 关系 。 无 论 激励 
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状态 如 何 ， 传 送 器 趋向 于 对 准 到 一 系列 期 望 的 位 置 ， 这 样 就 出 现 了 齿 定 位 力 。 导 
致 PMLM 周期 齿 定 位 力 存 在 的 两 个 法 在 原因 是 传送 器 铁 芯 的 有 限 长 度 和 开 槽 。 
与 传送 器 和 磁铁 之 间 相 对 位 置 有 关 的 绕组 自 感 变化 产生 了 磁 阻 力 。 于 是 ， 磁 阻力 
与 传送 器 和 磁铁 的 位 置 也 有 周期 关系 。 

总 体 上 来 说 ， 齿 定位 力 和 磁 阻力 构成 了 整体 力 波动 现 象 。 即 使 PMLM 不 供 
电 ， 当 传送 器 沿 导轨 移动 时 ， 力 的 波动 显然 也 存在 。 在 离散 点 上 会 经 历 最 小 /最 
大 的 阻力 。 在 较 低 的 速度 下 ， 由 于 低 动量 用 来 克服 磁 阻 ， 波 动 效应 更 为 明显 。 

由 于 直线 电动 机 的 直接 驱动 原理 ， 波 动力 在 精确 定位 上 具有 重要 的 意义 ， 它 
也 可 能 引起 的 振荡 ， 并 产生 稳定 问题 ， 特 别 是 低速 度 或 轻 载 ( 低 动量 ) 的 情况 。 
图 2. 15 所 示 为 由 英国 线性 驱动 器 公司 (Linear Drive, UK) 制造 的 管状 PMLM 的 
实时 开 环 阶 路 响应。 图 2. 16 所 示 为 具有 不 同步 长 〈( 即 不 同 的 稳 态 速度 ) PMLM 
的 速度 /位 置 特征 。 


输入 电压 为 1.2V 





0 0.5 15 2 


1 
时 间 /s 
图 2.15 PMLM 的 开 环 阶 跃 响应 


从 这 些 响应 可 以 推断 出 一 些 有 趣 的 
结论 。 首 先 ， 波 动 频率 不 依赖 于 步 长 





7 
6 
( 即 独立 于 速度 ) ， 但 表现 出 与 位 置 有 固 £S 
定 的 关系 。 第 二 ， 波 动 幅度 取决 于 位 置 BV LO ON 人 ~、 
和 速度 。 在 较 高 的 速度 下 ， 波 动 幅度 的 ay 7 L \ 
降低 相 比 ， 当 PMLM 运行 在 较 低 速度 时 ， o 一 一 输入 电压 为 16V | 
波动 效应 比较 明显 。 loos 113 a ad 4 
力 波动 的 一 阶 模型 可 以 描述 为 一 周 f/x10 bm 
期 正弦 型 信和 号 图 2. 16 对 应 不 同 阶 跃 电压 下 的 
Fm (x) =A(x)sin( wx +p) (2.55) RE (pms) /位 置 (um) 特征 


波动 的 高 次 谐 波 可 以 包含 在 更 高 阶 的 模型 里 。 


第 2 章 精密 跟踪 运动 控制 .25. 





2.2.4 摩擦 


EBA nD eh FRET LE A Lo, RE A 
是 一 个 主要 不 利 因素 。 根 据 摩擦 性 能 的 特点 ， 可 将 摩擦 细 分 为 两 类 ， 静态 摩擦 和 
动态 摩 氛 。 摩 氛 的 静态 特性 包括 黏附 摩 氛 、 动 力学 力 、 黏 性 力 及 斯 特 里 贝克 作 
用 ， 是 稳 态 速度 的 函数 。 动 态 现象 包括 预 滑动 位 移 、 不 同 的 分 离 力 和 摩 氛 滞 后 。 
许多 经 验 摩 擦 模型 已 经 建立 用 来 尝试 捕 提 摩擦 行为 的 具体 组 成 部 分 ， 但 一 般 来 
说 ， 以 明确 的 形式 获得 精密 的 摩擦 模型 是 十 分 困难 的 ， 特 别 是 对 动力 部 件 。 但 是 
对 于 许多 应 用 ， 已 证 明 塔 斯 廷 模型 是 有 用 的 ， 它 在 许多 成 功 的 应 用 中 得 到 了 充分 
的 验证 。 塔 斯 廷 模型 可 以 写成 

F pisin =F, + (F, -F,)e Ms + F Ixl Jsgn(x) (2. 56) 

HH, F, 表示 静摩擦 力 ; Fo RACER Or 
最 小 值 ，x, AF, 为 润滑 和 人 负载 参数 ; 8 为 
另外 一 个 经 验 参 数 。 图 2. 17 所 示 为 塔 斯 廷 
摩擦 模型 。 

考虑 到 这 些 非 线性 效应 ，PMLM 动态 





摩擦 力 /N 





可 描述 为 | | 
K. K, “5-1 050 05 
x= 一 一 有 +t OF a +F nipple + F friction ) 速度 /( m/s) 


(2.57) 图 2.17 KIERR 
使 用 高 品质 的 轴承 可 以 大 大 减少 摩擦 的 影响 ,例如 静 压 或 磁力 轴承 等 。 
2.2.5 复合 控制 


在 这 种 机 制 下 ,采用 三 层 复合 控制 结构 ， 如 图 2. 18 所 示 ， 包 括 三 个 控制 组 
成 部 分 : 前 馈 控制 、 反 馈 控 制 和 基于 补偿 器 的 非 线 性 径 向 其 枉 数 (RBF) 的 。 为 
了 使 这 种 方法 公式 化 ， 一 个 通用 的 非 线 性 函数 Fr (x,x) 可 以 用 来 代表 非 线性 动 
态 效 应 ， 由 于 存在 力 波动 ， 摩 擦 和 其 他 未 知 的 动态 集合 。 式 (2. 57) 的 伺服 系 
统 因而 可 选择 描述 为 


K. K, . . 
x= ~ + hu Feat + Fy (x,x) (2. 58) 
令 
wile, x)= Gy toot + FY (x,x) (2. 59) 
由 此 可 见 


„K. Kk K . 
t= -gtu tp A (2.60) 
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前 馈 控 制 
~l x t 
arid O toe(i hfe 1+ kjelt) -O 














图 2.18 三 层 复 合 控制 方案 


岂 x,x) 假 定 为 平滑 非 线性 函数 ， 可 能 是 未 知 的 。 


为 此 ， 但 是 它 可 能 会 指出 ， 许 多 不 连续 的 非 线性 函数 可 以 充分 近似 一 项 持续 不 
断 的 。 


由 于 跟踪 误差 。 定义 为 
e€=%4-% 
方程 (2. 60) 可 表示 为 
3 (2.61) 


Pitt “[e(s)de = e, 


该 系统 的 状态 变量 指定 为 <， = [e(t)dt, x, = efn = 6. 
定义 x= [xixaxs] ， 然 后 式 (2.61) 可 代入 等 价 状态 空间 形式 


š =Ax + Bu + Bf(x,%) +B -My -ta (2.63) 
K,” K, 
01 0 0 
sfo 0 1 | | 0 | (2. 64) 
0 0 -K,/M -K,/M 


1. AURIS el 
该 前 馈 控 制 律 的 设计 非常 简单 。 根 据 方程 (2. 63 ) ， 在 控制 信号 中 可 使 用 前 


绩 控 制 项 匹配 B| - Ma, - 屁 训 项 ， 前 久 控 制 因 而 设计 为 


Welt) = + (2.65) 

显然 ， 参考 位 置 轨迹 必须 是 连续 的 和 二 次 可 微 的 ， 否 则 必须 用 预 补偿 器 来 滤 

波 参考 信号 。 为 前 馈 控 制 设计 所 需 的 唯一 的 参数 是 二 阶 线性 模型 的 参数 。 另 外 ， 
如 果 有 适当 模型 可 选择 ， 前 馈 项 可 列 人 了 非 线性 效应 。 例 如 ， 如 果 一 个 好 的 波动 
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力 信号 模型 可 以 用 公式 (2.55) 表示 ,那么 前 馈 控 制 信号 中 另 一 静态 项 un = 
KP nets) 可 以 有 效 地 补偿 波动 力 。 如 果 摩 擦 模 型 可 用 ， 以 同样 的 方式 可 安装 


静态 摩擦 前 馈 预 补偿 器 。 根 据 所 有 前 馈 控制 方案 的 特点 ， 控 制 性 能 非常 依赖 于 模 
型 参数 的 精度 。 因 此 ， 通 常 是 与 适当 反馈 控制 方案 一 起 增加 前 馈 。 
2. PID 反馈 控制 
尽管 过 去 五 十 年 里 控制 理论 有 了 进展 ， 但 工业 伺服 控制 回路 仍 主要 是 依赖 于 
三 项 参数 的 PID 控制 器 。 主 要 原因 是 工业 领域 广泛 接受 了 这 个 简单 的 控制 器 。 在 
大 多 数 情况 下 ， 如 果 调 整 适当 ，BPID 控制 器 是 有 效 和 可 人 靠 的 控制 器 。 较 复杂 的 先 
进 控制 器 在 实际 应 用 中 表现 得 并 不 出 色 ， 而 且 还 要 更 高 的 成 本 ， 控 制 调整 有 更 高 
的 要 求 。 这 对 于 使 用 先进 而 陌生 的 控制 器 的 运营 商 来 说 ， 调 整 控 制 参数 是 非常 困 
难 的 。 由 于 这 些 不 确定 因素 , PID 控制 器 每 年 产量 达 100 万 台 ， 并 且 仍 然 在 增加 。 
综合 控制 系统 的 PID 用 作 反 馈 控制 项 。 虽 然 PID 结构 简单 ， 但 也 常 是 随时 宜 称 控 
制 效果 不 佳 的 原因 。 在 综合 控制 系统 设计 中 ， 先 进 的 最 优 控制 理论 用 来 调整 PID 
控制 增益 。PID 反馈 控制 器 的 设计 方式 使 用 了 线性 二 次 调节 器 (LOR) 的 技术 ， 
来 优化 并 稳健 标 称 系统 的 性 能 。 前 馈 加 反馈 结构 通常 也 称 为 两 自由 度 (2-DOF ) 
控制 。 
该 系统 的 标 称 部 分 (没有 不 确定 性 ) 由 式 (2.66) 给 出 
x(t) =Ax(t) + Bu(t) (2, 66) 
其 中 
Upp = Kx = kx, + kanx, + kpxs (2.67) 
这 是 一 个 利用 全 状态 反馈 的 PID 控制 结构 。 
众所周知 ， 最 优 PID 控制 参数 可 获得 最 优 控制 技术 的 应 用 ， 不 但 为 现代 最 优 
控制 理论 所 证 明 ， 而 且 在 许多 方面 得 到 了 广泛 应 用 。PID 控制 有 很 好 的 鲁 棒 性 ， 
即 如 果 这 一 过 程 是 单 输 入 单 输出 系统 ， 那 么 控制 系统 至 少 有 60? 的 相位 裕 度 和 无 
穷 大 的 增益 裕 度 。 这 种 特性 对 应 用 人 员 有 很 大 的 吸引 力 。 因 此 ， 从 20 世纪 50 年 
代 以 来 ，LQR 理论 就 得 到 了 相当 大 的 关注 。 


PID 控制 给 定 如 下 . 
Upp = — (ro +1) B'Px(t) (2.68) 
H+, PERRI (Riccati) 方程 的 正定 解 
4pP+P4-PBBIP+O=0 (2. 69) 


H#HQ=HH, 其 中 , 已 通常 是 有 关 方法 的 加 权 参 数 。 请 注意 ，m 是 独立 于 P 
的 ， 被 引入 以 均衡 控制 力 和 控制 的 误差 之 间 的 相对 作用 。 这 种 反馈 控制 只 需要 二 
阶 参数 模型 的 参数 和 用 户 指 定 的 误差 权重 ro 

根据 适当 假设 ,一 个 实际 有 用 的 与 LOR 的 设计 有 关 的 特性 是 : 由 此 产生 的 
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闭环 系统 始终 是 稳定 的 。 此 功能 归纳 为 以 下 引 理 。 
引 理 2.1 对 于 方程 (2.66) 的 系统 ， 如 果 (4,8) 是 可 控 和 ( 互 ,4) 是 可 观测 
的 ， 那 么 控制 律 方程 (2. 68) 可 使 方程 (2.66) 的 系统 稳定 下 来 。 
3. 径 向 基 范 数 补偿 
两 自由 度 控制 可 能 满足 许多 实际 控制 要 求 。 然 而 ， 如 果 需 要 进一步 提高 性 
能 ， 第 三 个 控制 组 件 可 能 会 被 启用 。 径 向 基 郴 数 补偿 (RBF) 用 于 对 非 线性 余 项 
进行 建 模 ， 这 在 随后 线性 化 闭环 系统 时 ， 用 以 匹配 系统 RBF 的 非 线性 部 分 。 许 
多 神经 网 络 的 方法 经 常用 来 对 未 明确 界定 的 非 线性 函数 建 模 。 对 径 向 基 函 数 补偿 
在 神经 网 络 内 的 隐 单 元 提供 了 一 个 基本 函数 集合 ， 这 些 单元 可 扩大 到 更 高 维 的 隐 
单元 空间 。 
由 于 /(%,x) 是 一 个 非 线性 光滑 函数 (未知) ， 它 可 以 表示 为 
fis) = Ywl) te = 了 和 (om +e (2.70) 
与 | e| <en, XH g(x) BRMMM (RBF) 给 出 如 下 
中 (55x) = exp( - Lsi) $ exo - lze- ol ) (2.71) 


其 中 , x,w= [x No 
可 作出 以 下 假设 。 

假设 2.1 理想 的 权重 是 被 限定 在 已 知 正 值 的 范围 内 ,使 得 ，1w;| < wx， 
i=1, 2,,..mo 

假设 2.2 存在 一 个 ew >0， 使 得 le(x,x*)|<ey,VxwaE Fo 

A Xt f(x x) BY RBE 函数 估计 为 





Hann) = Dhl) a, (2.72) 
Hih, o, 是 理想 RBF 权重 的 估计 ， 由 以 下 权 调 整 算法 提供 
Ô; =mxzTPB - 1, ow, (2.73) 
其 中 ，r >0，nm >0, P 是 方程 (2. 69) 的 解 。 因 此 ，RBF 自 适应 控制 部 分 为 
Urge = -f %,x) (2. 74) 


总 的 控制 信号 是 U = Upp + Upip + Urro 

4. 标 称 系统 的 参数 估计 

根据 控制 结构 下 ， 二 阶 模型 对 计算 控制 参数 是 必要 的 。 许 多 方法 可 用 于 产生 
所 需 的 线性 模型 (Ljung 1997 ) 。 参 数 估 计 方 法 是 流行 的 方法 。 考 虑 给 出 一 个 
ARX 模型 如 下 
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y(t) tayy(t-1) +t +a, y(t -na) =bu(t—-1) +- +b u(t-n,) +e(t) 
(2.75) 
Hp, n, ERAK, n+l 是 零点 的 数 ，e(i) 代 表 系 统 的 误差 项 。 根 据 该 模型 ， 
线性 预测 为 
Yp) =W) +e(t) (2.76) 
这 里 
W(t) =[-y(t-1) -y(t-2) + -y(t-n,)u(t-1)+-u(t-n,) 1" 
y =[a an, bb, ] 
由 方程 (2.76) ， 预 测 误差 为 . 
elta) =y) -PO (2.77) 
定义 模型 匹配 指标 函数 为 


Vy) = yd gly) -OT (2.78) 

这 是 最 小 二 乘 准则 。 这 一 指标 可 以 解析 减 至 最 低 ， 给 出 该 模型 的 参数 的 最 小 
二 乘 估计 为 

ij roro] 六 六 了 CDy() (2.79) 


应 该 使 用 持续 激励 的 输 和 信号， 可 以 是 明确 的 输入 序列 〈 例 如 伪 随 机 二 进 
制 序列 ); 也 可 以 自然 从 闭环 控制 产生 信号 ， 在 这 种 情况 下 不 需要 进行 明确 的 
试验 。 

使 用 明确 的 用 户 定义 的 输入 信号 ， 上 述 参 数 估计 将 产生 线性 模型 参数 的 初始 
设置 。 此 后 ， 使 用 的 输入 增 量 测量 ， 并 根据 系统 的 输出 信和 号 可 以 修订 该 模型 ， 利 
用 递 推 版 最 小 二 乘 估计 算法 (Ljung 1997 Æ) 闭环 控制 ， 即 直线 驱动 器 在 线 正 常 
运动 操作 就 可 以 重新 细 化 模型 参数 。 

5. 稳定 性 分 析 

需要 表明 ， 在 复合 控制 的 作用 下 状态 * 和 权重 要 保持 有 界 。 下 面 的 定理 对 说 
明 稳 定性 是 有 用 的 。 

定理 2.2 假设 所 需 的 参考 xs Re, 有 界 。 考 虑 由 方程 (2.65) 方程 (2.67) 
和 方程 (2.74) 给 出 的 控制 器 应 用 在 式 (2.63) 系统 的 情况 。 其 次 ， 状 态 和 径 
向 估计 误差 为 一 致 最 终 有 界 。 

TERR: 式 (2.63) 微分 方程 可 以 写 为 (应 用 方程 (2.65)、 方 程 (2.67) 
和 方程 (2.74) 的 控制 ) 


. . K 
x =Ax + BC upp + Upp + Urge) + BFC%,% 4%) +B| -Kä -g*a] (2. 80) 
2 2 
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= [A - (ro + 1)BB"P]s -BY bt, + BÍ [$ bw, +e] (2.81) 
= [A — BB'P - r,BB'P]x +BLY 4, č, +e] (2. 82) 

现在 考虑 下 面 的 李 雅 普 诺 夫 (Lyapunov) 函数 的 选项 
V(x, @) = srPz + 二 了 5? (2. 83) 


按 方程 (2.82) 取 V 解 的 时 间 导 数 ， 它 可 以 表示 为 
V = x (ATP + PA - PBB'P)x + x'(—2r, - PBB'P)x 


+2x"PBY 由 ü, + 2x'PBe +e Bw, 
i=0 


名 t 了 
=-A,,,1Q + (2r, +1)PBB'P] || x ||’ + 2x' PB 中 Ü, 
i=0 
+ 2xrPBe +29 (-2"PB$, + th) i, 
i=0 1 


=— Àmnl Q + (2ro + 1)PBB'P] || x ||? +2x"PBe 


=~-A,,,[Q + (2r, + 1)PBB'P] || x |? +2x'PBe 


-225 674225 w, ü, (2. 84) 
Ty 7=0 Ty i=0 
其 中 ， 2x"PBe <x" PBB’ Px + Le 
7 

<x" PBB" Px + 7$ (2. 85) 

T3 r, 2 Brna 
2 一 Wi WE- Ww; + | (2. 86) 

rn" Br nn : 


VS - {Angin Q + (2r +1) PBB"P] + An PBB'P)} || x ||? 


-2280 3) +e + awl (2. 87) 


1 
定义 9= [ x” Ù o Dren], 满足 
Vs -2y || 0 ||? +A, (2.88) 
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其 中 ， = 六 miziAws[Q@+(2ro+1)PBBTP)] ~ ga, (PBB"P) 
Ta 1 
3138)| (2. 89) 
A, ste rgi (2.90) 
BR, y>0 fin, B 足够 小 。W 为 负 必 须 满足 以 下 条 件 
A, 1/2 
loi > (5) (2.91) 
为 了 显示 对 状态 和 权 的 有 界 性 ， 注 意 从 
x( || 617) <V<v( | 04) (2. 92) 
得 
2 -2yi/y Aw a pT? a 
Nail <[ | 60) pet +51 ey (2.93) 


这 里 ， w=min{A,,,(P) ,1/r,} vy =max{A,,.(P) ,LA |。 

从 式 (2.93) 可 以 得 出 结论 认为 ， 状 态 和 权 有 界 。 证 毕 。 

6. 评注 2.1 

对 于 方程 (2.73) 的 自 适应 方案 ， 随 着 x PBS, 增加 ， 第 一 项 增长 迅速 (这 
反映 了 较 差 的 系统 性 能 ) 。 这 将 导致 @; 高 速 增长 ， 并 且 因 此 反馈 强烈 。 参 数 x， 
提供 了 上 91 和 16,1 之 间 相对 最 终 幅 度 的 设计 折 中 。 

7. 试验 

试验 结果 用 来 说 明 控制 方案 的 有 效 性 。 采 用 直线 电动 机 是 一 个 直接 推力 管 
状 的 直线 伺服 电动 机 (LD 3810)， 由 驱动 器 有 限 公 司 (LDL) 制造 ， 拥 有 运 
行 长 度 500mm， 装 有 一 个 雷 尼 绍 (Renishaw) tym 效应 光电 编码 器 。 使 用 
dSPACE 实时 控制 开发 和 基于 DS1102 板 的 快速 原型 系统 。dSPACE 将 整个 开发 周 
期 无 颖 集成 到 一 个 单一 的 环境 ， 使 
仿真 和 测试 之 间 的 开发 阶段 可 以 重 
新 运行 ， 而 不 需要 任何 频繁 的 重新 
调整 。 试 验 装 置 如 图 2. 19 所 示 ， 功 
能 框图 如 图 2. 20 所 示 。 随 后 讨论 
的 许多 试验 结果 都 是 根据 这 个 试验 
平台 的 。 | 

使 用 复合 控制 获得 的 跟踪 性 能 ， 
如 图 2. 21 所 示 。 选 择 正弦 参考 轨 
迹 ， 达 到 最 高 小 于 4pm 的 误差 。 图 2. 19 试验 装置 
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图 2.20 建立 试验 的 功能 框图 
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图 2. 21 使 用 复合 控制 获得 的 跟踪 性 能 


2.2.6 加 速度 控制 增强 


在 许多 关于 先进 运动 控制 的 文献 中 ， 无 论 加 速度 信号 是 用 测量 形式 还 是 导数 
形式 ， 通 常 都 是 可 用 的 。 但 在 实践 中 ， 人 们 很 少 能 遇 到 相关 对 象 可 有 效 利 用 的 加 
速度 测量 。 这 种 现象 的 产生 有 几 个 原因 。 首 先 ， 性 能 优良 的 加 速度 计 非 常 昂 贵 ， 
而 且 还 没有 组 件 的 使 用 标准 。 但 是 随 着 微型 设备 大 规模 生产 过 程 的 发 展 ， 加 速度 
计 的 成 本 显著 地 减少 了 ， 现 在 开始 广泛 使 用 。 其 次 ， 尽 管 相关 成 本 高 ， 加 速度 计 
的 信和 号 非常 喇 杂 ， 因 此 限制 了 其 在 振动 、 冲 击 和 力 测量 中 的 应 用 。 这 里 信和 号 包括 
实际 最 重要 的 信号 内 容 。 其 他 加 速度 测量 的 应 用 可 以 在 迈克 罗 尼 (McInroy) 和 
萨 利 迪 斯 (Saridis) (1990 Æ), ， 德 杰克 (de Jager) (1994 年 ) ,怀特 (White) 
MEg (Tomizuka) (1997 Æ) 的 文献 中 找到 。 以 下 讨论 显示 : 合适 的 数字 滤 


第 2 章 “精密 跟踪 运动 控制 -33- 





波 技术 可 以 将 噪声 的 相关 问题 降低 到 一 定 水 平 ， 信 号 可 直接 由 控制 器 分 析 使 
用 。 第 三 , 正如 德 杰克 (de Jager) 在 1994 年 论述 的 ， 由 于 采用 反馈 输入 的 加 
速度 测量 ， 加 速度 反馈 可 以 直接 引入 代数 环 ， 但 其 作用 实际 意义 不 大 ， 原 因 
如 下 : 

1) 通常 滤波 器 要 滤波 加 速度 信和 号， 这 个 滤波 器 将 产生 一 段 时 间 的 延 时 ， 将 
破坏 代数 环 。 

2) 即使 在 缺少 滤波 器 的 情况 下 ， 执 行 机 构 和 系统 动力 学 固有 的 低 通 特性 是 
天 然 的 滤波 器 ， 从 而 消除 了 代数 环 。 

无 论 是 前 馈 模 式 还 是 反馈 模式 ， 加 速度 测量 都 可 用 于 控制 器 。 在 前 馈 模式 
(White 和 Tomizuka 1997 年 )， 从 加 速度 测量 构建 的 前 馈 控 制 信号 给 被 控 系统 提 
供 了 一 个 直接 和 即时 的 补偿 。 但 是 ， 这 种 方法 很 大 程度 上 依赖 于 系统 模型 的 准确 
性 ， 其 他 方法 是 在 反馈 控制 法 中 使 用 加 速度 测量 。 正 如 de Jager 于 1994 年 提出 
的 ， 除 了 直接 使 用 上 面 讨 论 的 加 速度 测量 ， 还 可 以 利用 加 速度 观测 器 的 间接 测量 
提高 速度 信号 的 估计 ， 否 则 速度 信号 由 位 置 测量 产生 。 

1. 加 速度 计 

加 速度 计 通 常 采用 完全 主动 或 半 主 动 惠 斯 通 桥 组 成 ， 可 以 是 扩散 、 植 人 
(HF) 或 薄膜 的 半导体 应 变 片 ， 也 可 以 是 外 延 压 电 电阻 应 变 计 , 或 者 是 金属 箱 
应 变 计 。 应 变 计 要 么 粘 合 在 一 个 加 速 传感器 单元 上 ， 这 个 单元 固定 在 一 个 或 多 个 
表面 上 ， 要 么 扩散 、 植 人 或 生长 成 为 传 感 单元 的 一 部 分 。 其 他 技术 如 力 敏感 的 介 
质 技 术 也 可 以 使 用 ， 如 微机 械 隔膜 或 力 收集 器 。 加 速度 单元 在 一 些 点 上 支撑 着 质 
量 ， 该 质量 沿 自由 长 度 经 爱 加 速度 时 ， 它 就 产生 了 弯曲 或 变形 ， 从 而 产生 了 应 变 
计 应 变 。 这 种 应 变 与 作用 的 加 速度 成 正比 。 由 于 应 变 计 放 置 在 拉 伸 和 压缩 的 地 
方 ， 应 变 的 压力 导致 激励 电压 桥 不 平衡 。 这 种 不 平衡 现象 反 过 来 减少 了 电 桥 电压 
的 变化 ， 电 桥 的 输出 与 加 速度 对 质量 的 作用 成 比例 。 

Entran Sensors & Electronics 公司 的 EGCS-A 系列 加 速度 计 具 有 高 灵敏 度 且 坚 
固 耐 用 ， 因 此 在 这 里 被 选择 使 用 。 由 于 内 置 仪表 放大 器 ， 这 种 系列 的 加 速 计 提 供 
了 强大 适用 的 信号 ， 并 且 有 令 人 印象 深刻 的 紧凑 封装 (ECCS-A2 的 尺寸 为 
16mm x 16mm x 16mm) 。 

EGCS 系列 加 速度 计 的 基本 规格 如 表 2. 1 所 示 。 降 低频 率 带 宽 并 且 限 制 g 跨 
量程 应 用 时 ，g 的 测量 范围 减 小 使 加 速度 计 的 敏感 性 增加 。 对 于 关注 的 应 用 ， 需 
要 频率 带宽 大 约 在 200Hz 的 加 速度 传感器 ， 因 为 PMLM 控制 系统 带宽 要 求 为 
20 ~80Hz。 同 时 ， 对 应 振动 分 析 和 线性 驱动 器 的 监测 ( 见 第 7 章 内 容 ) ， 此 带宽 
相同 的 加 速度 计 也 可 以 使 用 。 由 于 这 些 原因 ， 选 择 EGCS-A2-10。EGCS-A2-10 加 
速度 计 规 格 如 表 2. 2 所 示 。 还 应 当 指出 ，EGCS-A2-10 有 一 个 标准 补偿 (ABB) 
温度 ， 范 围 为 20 ~80Y 。 
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表 2.1 EGCS 系列 加 速度 计 的 基本 规格 





































频率 特性 
g CHER) | 8 超 量 程 限 制 ( + 二 dBYHz 固有 频率 /Hz REE A) May 

+2 | +200 0 ~90/50 2500 £5 

+5 +500 0 ~ 150/80 1000 £5 
+10 +1000 0 ~ 200/120 400 500 +5 
+25 +2000 0 ~ 400/240 800 200 £5 
+50 +5000 0 ~ 600/350 1200 100 £5 
+100 + 10000 0 ~ 900/500 1800 +5 
+500 + 10000 0 ~ 1700/1000 3500 +5 
+1000 + 10000 0 ~ 2500/1500 +5 





$2.2 EGCS-A2-10 加 速度 计 规 格 
参数 x ff 单 ft % È 
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EGCS-A2-10 加 速度 计 首 先 要 做 频率 校准 ， 主 要 以 验证 其 规程 。 这 对 其 后 主 
要 决定 这 些 加 速度 计 频率 响应 的 数字 信和 号 调节 设 定 是 十 分 必要 和 重要 的 。 进 行 这 
项 试验 是 靠 一 个 专用 振动 台 ， 功 率 谱 分 析 采 用 惠普 FFT 分 析 仪 。 校 准 结果 如 图 
2.22 所 示 ， 频 率 为 150Hz。 由 图 2.22 Bray, 这 个 频率 的 幅度 响应 为 20log 
(0. 2856/0. 3035) = -0.03dB。 这 就 核实 了 加 速度 计 的 标 称 和 最 小 的 频率 带宽 。 

为 了 实现 应 用 加 速度 计 的 精确 测量 ， 重 要 的 是 加 速度 计 必 须 牢固 地 安装 到 测 
试 对 象 上 。 环 氧 树脂 封装 或 外 部 钳 位 是 典型 的 安装 方法 ， 加 速 计 安装 没有 和 孔 或 螺 
栓 时 ， 可 以 选择 使 用 胶粘剂 。 应 该 指出 的 是 ， 如 果 安 装 变 得 松散 ， 加 速度 计 频率 
特性 可 能 会 退化 或 扭曲 ， 因 此 安装 过 程 必 须 十 分 小 心 。 安 装 的 放大 视图 如 
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图 2.22 校准 结果 : 振动 激发 与 150Hz 响应 的 功率 谱 


图 2. 23 所 示 。 这 里 使 用 的 测试 平台 是 一 个 有 刷 直 流 永 磁 直线 电动 机 ( PMLM ) 
由 Anorad 公司 制造 ， 加 速度 计 上 g 方向 的 箭头 标志 必须 严格 与 测量 轴 对 齐 。 





a) b) 


图 2.23 加 速度 计 安 装 的 放大 视图 
a) 顶部 查看 b) 近 距 离 查看 


可 以 考虑 采用 永久 性 的 EGCS-A2-10 安装 ， 如 采用 安装 螺钉 或 螺栓 。 在 这 种 
情况 下 ， 整 个 表面 必须 牢固 地 与 试验 对 象 接触 旦 没有 灰尘 ， 加 速度 计 与 安装 表面 
之 间 也 要 去 除 灰尘 。 否 则 ， 测 试 表面 上 的 加 速度 计 可 能 产生 振动 ， 给 出 带 误差 的 
结果 ， 并 损坏 其 他 单元 。 

安装 后 ，EGCS-A2-10 传感器 由 一 个 24V 直流 电源 供电 。 传 感 器 连接 到 控制 
系统 的 A/D 通道 ， 通 过 A/D 转换 校准 进行 归 零 检验 。 与 此 同时 ,测量 因子 也 确 
定 为 43/m +s? (十 进 制 ) 。 
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初步 的 加 速度 信号 典型 记录 如 图 2. 24 所 示 。 显 然 ， 为 达到 控制 目的 ， 对 所 
要 求 提供 切实 有 用 的 运动 信息 来 说 ， 这 种 信号 的 噪声 还 是 太 多 了 。 然 而 ， 高 频 波 
动 是 无 偏 的 ， 用 肉眼 就 可 以 看 到 平滑 加 速 的 轮廓 。 这 意味 着 ,适当 滤波 噪声 信号 
必 不 可 少 。 加 速度 也 可 能 通过 的 位 置 数 据 微分 获得 。 微 分 产生 的 信号 如 图 2. 24b 
所 示 ， 具 有 整体 较 高 的 信 品 比 (SNR). 


加 速度 /(m/s?) 
加 速度 /(m/s?) 








06 08 | 0 02 04 


0 02 06 
时 间 /s 
a) b) 
图 2.24 初步 的 加 速度 信号 典型 记录 
a) 加 速度 计 b) 根据 位 置 测量 的 双 数 值 微分 


0.4 
时 间 /s 


根据 巴特 沃 斯 滤波 器 的 幅 频 响 应 特点 ， 使 用 了 阿 巴特 沃 斯 低 通 数字 滤波 器 ， 
它 有 最 大 限度 的 通 带 平坦 ， 并 在 整个 频率 范围 内 严格 单调 。 截 止 频率 w,， 标 定 
在 0.0 和 1.0 之 间 ， 确定 对 应 1.0 一 半 的 采样 频率 。 对 应 所 研究 的 系统 ， 采 样 率 
设置 为 0. 001s。 考 虑 到 该 加 速度 计 的 频率 特性 和 闭环 控制 的 带宽 ， 截 止 频率 设 
置 为 80Hz， 滤 波 器 的 阶 数 设置 为 3。 巴 特 沃 斯 模拟 低 通 滤波 器 原型 的 幅 频 响 应 函 
数 的 平方 给 定 如 下 
1 


IH I? = 
a(w) 1 +w 





(2.94) 


等 价 数字 滤波 器 是 
1、 _0. 0102 +0. 0305z-1 +0. 0305z-? +0.0102z” 

Balz )= 1 > 00382"! 41. 447127? —0. 361827? (059 
比较 双 加 速度 计 和 双 微 分 信和 号 质量 ,滤波 后 的 加 速度 信号 如 图 2. 25 所 示 。 理 想 
的 加 速度 信号 的 比较 也 在 图 2.25 中 给 出 。 从 理想 位 置 跟踪 轨迹 获得 的 理想 加 速 
度 是 预先 规划 的 时 间 上 的 多 项 式 函 数 ， 它 满足 静止 运动 至 静止 的 钟 式 速度 剖面 。 
在 原始 信和 号 与 滤波 信号 之 间 存 在 着 相 移 。 零 相位 后 置 滤波 器 可 以 用 来 表示 这 
种 相 移 。 在 图 2. 26 中 ， 实 线 表示 滤波 器 的 输出 ， 显 然 比 滤波 器 丽 (z !') 有 H(z) 零 
相位 输出 的 虚线 有 一 定 的 相位 延迟 。 由 于 非 因果 关系 ， 实 现实 时 零 时 间 相 位 滤波 
ASE A AT REA. Hel) 的 实时 实现 是 一 个 递归 无 限 脉冲 响应 (IR) 滤波 器 ， 
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延迟 不 可 避免 。 然 而 ， 滤 波 延 迟 的 影响 不 宜 过 大 ， 这 样 可 以 不 减弱 加 速度 反馈 带 


来 的 好 处 。 
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a) b) 
图 2.25 滤波 后 的 加 速度 信号 
a) 加 速度 计 b) 双 数 值 微分 的 位 置 测量 
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0.4 0.6 
时 间 /s 
图 2.26 相位 延迟 的 滤波 加 速度 信和 号 


2. 全 状态 反馈 控制 

由 于 可 以 利用 更 多 的 加 速度 信号 ,设计 和 应 用 全 状态 反馈 控制 器 来 替代 PID 
控制 器 。 这 种 额外 的 状态 反馈 可 以 得 到 某 些 改善 结果 。 基 于 阿 克 曼 (Ackermann) 
公式 的 极点 配置 设计 方法 ， 能 够 提供 一 种 自然 的 规范 ， 它 可 以 满足 理想 固有 频率 
和 闭环 阻尼 方面 的 实际 要 求 。 确 定 阻 尼 比 5 =0.707 和 25Hz 固有 频率 的 二 阶 主导 
期 望 响应 参考 模型 。 

为 了 清楚 地 说 明 增 强 了 控制 性 能 ,全 状态 反馈 控制 与 使 用 前 馈 反 馈 配 置 的 
PID 控制 相 比 较 。 参 考 信号 由 一 个 正弦 波 给 定 : r(t) =0. lsinmt。 

图 2. 27 所 示 为 跟踪 误差 的 比较 。 可 以 观察 到 改善 超过 50% ， 局 部 图 如 图 
2. 28 所 示 。 
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图 2.27 跟踪 误差 比较 : 全 状态 反馈 〈 带 加 速度 计 ) 与 传统 调节 PID 控制 器 (不 带 加 速度 计 ) 
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图 2.28 跟踪 误差 比较 : 局 部 图 


2.2.7 波动 补偿 


从 运动 控制 的 观点 来 看 ， 力 波动 是 非常 不 理想 的 ， 但 它们 主要 存在 于 永 磁 直 
线 电动 机 (PMLM) 中 。 波 动 可 以 尽量 减少 ， 其 至 改变 电动 机 设计 的 结构 或 磁 材 
料 空间 的 布局 就 可 以 消除 ， 例 如 弯曲 磁铁 、 优 化 磁体 位 置 和 宽度 等 。 这 些 方法 往 
往 增加 了 电动 机 结构 的 复杂 性 。 具 有 无 槽 配置 的 永 磁 直线 电动 机 (PMLM) 如 图 
2.29 所 示 ， 是 一 种 很 受 欢迎 的 直线 电动 机 ， 因 为 模 孔 产生 的 齿 定位 力 完全 被 消 
除 。 然 而 ， 由 于 有 限 长 的 铁 芯 传送 器 ， 电 动机 可 能 仍然 表现 出 明显 的 齿 定位 力 。 
有 限 元 分 析 证 实 ， 传 送 器 两 端 产生 的 力 是 正弦 和 单 向 的 。 由 于 传送 器 有 两 个 端 
(开头 端 和 结尾 端 ) ， 可 以 优化 磁体 的 长 度 ， 使 开头 和 结尾 端的 两 个 正弦 力 波 相互 
抵消 。 但 是 ， 这 又 在 一 定 程度 上 增加 了 机 械 结构 的 复杂 程度 。 一 个 更 实际 的 做 法 
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E: 绕组 芯 采 取 无 套 简 或 无 铁 芯 设计 以 消除 齿 定 位 力 。 例 如 ， 英 国 线性 驱动 器 公司 
(Linear Drives, UK) 提供 了 两 种 类 型 的 PMLM: 套 简 类 型 PMLM 和 无 套 简 类 型 
PMLM。 不 过 ， 芯 材料 减少 的 结果 会 导致 高 的 磁 通 泄漏 ， 这 是 一 个 非常 低 效 的 能 量 
转换 过 程 的 做 法 。 因 此 ， 产 生 的 推力 急剧 减少 (通常 是 30% 或 更 多 ) 。 这 种 解决 方 
案 对 必须 有 高 加 速度 应 用 的 场合 是 不 可 以 接受 的 。 此 外 ， 铁 芯 电动 机 生产 出 高 推 
力 ， 具 有 理想 的 加 速度 ， 可 移动 大 的 质量 ， 同 时 在 加 工 和 处 理 操作 时 保持 了 强度 。 


GZ 

















上 
图 2.29 管状 无 槽 PMLM 


在 这 里 使 用 了 一 种 基于 拌 动 信号 的 简单 方法 开发 称 为 “特洛伊 术 马 ”， 可 以 
取消 力 波动 的 影响 。 拌 动 信号 的 构造 需要 波动 力 特征 的 知识 ， 这 种 知识 可 以 从 单 
步 的 试验 中 获得 。 为 了 获得 更 好 的 鲁 棒 性 ， 实 时 运动 变量 的 反馈 可 用 于 自 适应 提 
取 拌 动 信 号 特征 。 该 方法 将 在 下 一 节 进 行 详细 的 介绍 。 

采用 一 个 三 层 复合 控制 结构 ， 如 图 2. 30 所 示 。 它 类 似 于 图 2. 18 的 结构 ,增设 
了 一 个 自 适 应 前 馈 控 制 组 件 ， 去 掉 了 RBF 的 补偿 器 。 复 合 控制 器 由 反馈 单元 
(PID) 、 前 馈 控制 器 (FFC) 和 自 适 应 前 馈 补 偿 器 (AFC) 组 成 。 前 馈 控 制 器 
(FFC) 的 设计 作为 快速 响应 的 先天 优势 着 线性 模型 ，PID 反馈 控制 提高 了 系统 的 
稳定 性 和 和 鲁 棒 性 ; AFC 是 自 适 应 抖动 信号 发 生 器 ， 目 的 是 消除 或 抑制 力 的 波动 效应 。 


FFC 


- + | 电动 机 
| L$ 


| 一 -一 一 AFC 











图 2.30 ”三 层 复合 控制 结构 


1。 自 适应 前 馈 单 元 
根据 网 2. 16 的 突出 的 特征 ,假设 力 波动 可 以 等 价 视 为 一 个 虚拟 输入 响应 . 
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以 周期 性 正弦 信和 号 形式 描述 如 下 


Uriple =A(%) Sin( wx +p) =A, (x) sinwx + A, (x)coswx (2. 96) 
从 而 相应 设计 抖动 信号 来 消除 这 种 虚拟 力 
Uapc =Q1(X(t) )sinwx +a, (x(t) )coswx (2. 97 ) 
消除 这 种 虚拟 力 后 ， 将 实现 
ay (*)=-A,(%) ax) = -A,(«) (2. 98) 


前 馈 补偿 方案 对 模型 误差 敏感 是 众所周知 的 ， 必 然 导 致 有 效 残 余波 动 。 这 里 采 
用 一 种 自 适应 方法 ， 因 此 根据 当前 的 期 望 轨迹 和 跟踪 误差 使 a, 和 a, 不 断 调 
整 。 令 

a(x) sinwx ， -A,(x) 
“Loe a=] | = -A,(%) (2.99) 
然后 给 出 对 于 AFC 的 系统 输出 
x, =P{a-a* ]"9 (2. 100) 


COSCOX 


其 中 ,PP 表示 系统 。 
方程 (2. 100) 满足 自 适 应 控制 理论 的 标准 结构 。 因 此 自 适 应 参数 更 新 律 是 
a,(«(t)) = — gesinwx (2.101) 
a,(x(t)) = — gecoswx (2. 102) 
其 中 ，g >0， 是 一 个 任意 调整 增益 。 
用 时 间 微 分 方程 (2. 101) 和 方程 (2. 102) ， 可 以 得 出 
a,(t) = -ge x,sin(wx) (2. 103) 
a,(t) = ~ ge x,cos( wx) (2. 104) 
” 换 句 话 说 , 方程 (2.103) 和 方程 (2. 104) 的 自 适 应 更 新 律 ， 能 用 来 作为 一 种 
调整 机 制 ， 使 式 (2.97) 的 a (1) Al a, (收敛 到 其 真实 值 。 
2. 模拟 结果 
本 节 将 介绍 一 个 快速 仿真 研究 的 结果 。 轨 迹 图 指定 为 
xu(T) =10°[xo + (xo -xr)(1S7 -6r -10r)] (2. 105) 
za(T) =10° (x4 xp) (607° -307 -307° ) (2. 106) 
其 中 ， 式 (2.106) 用 来 标 称 化 系统 单位 到 ymo xa Ax, 记 为 期 望 的 位 置 和 速度 
轨迹 ，xo Mx, 分 别 为 初始 和 最 终 的 位 置 。7 =i/(tj -6)， 其 中 如 和 是 轨迹 的 
初始 时 间 和 终端 时 间 。 
直线 电动 机 的 仿真 模型 是 一 个 管状 线性 无 槽 永 磁 电 动机 ， 由 英国 Linear 
Drive 公司 生产 。 控 制 方案 的 仿真 结果 如 图 2. 31 Ha. MLS, RE ANH 
动 的 复合 控制 仿真 结果 如 图 2. 32 所 示 。 显 而 易 见 ， 自 适应 抖动 贡献 了 很 卓越 的 
控制 性 能 。 
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图 2.31 控制 方案 的 仿真 结果 
a) 轨迹 b) 误差 c) 控制 信号 
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图 2.32 除去 自 适 应 抖动 的 复合 控制 仿真 结果 
a) 轨迹 b) 误差 c) 控制 信号 
3. 试验 


使 用 自 适应 波纹 补偿 器 (ARC) 的 试验 结果 如 图 2.33 和 图 2 34 所 示 ， 呈 现 出 最 
大 的 轨迹 误差 约 5pm。 应 该 指出 ， 这 个 结果 没有 采用 任何 RBF 网 络 。 为 了 进一步 说 
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明 自 适应 拌 动 的 效应 ， 没 有 拌 动 信号 控制 的 结果 如 图 2 35 所 示 。 除 了 减少 了 跟踪 误 
差 ， 注 意 在 图 2.35 中 反馈 信号 的 W 形 特 征 在 图 2.34 的 自 适 应 拌 动 结果 中 已 经 去 
除了 。 : 
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图 2.33 控制 方案 的 跟踪 性 能 
a) 期 望 轨 迹 b) 误差 c) 控制 信号 
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图 2.34 具有 控制 方案 的 控制 信号 单元 
a) 期 望 轨迹 b) 误差 o) 控制 信号 
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图 2.35 没有 自 适应 拌 动 的 试验 结果 
a) 期 望 轨迹 b) 误差 c) 控制 信号 


快速 傅 里 叶 变换 (FFT) 如 图 2.36 所 示 ， 用 来 检查 误差 信号 的 频率 内 容 。 
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图 2.36 误差 信号 的 快速 傅 里 叶 变换 
o a) $b b) KE 
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使 用 自 适 应 抖动 ， 误 差 频 谱 的 已 大 大 减少 ， 特 别 是 在 较 低 的 频率 范围 , 证 实 改善 
了 轨迹 的 跟踪 性 能 。 


2.2.8 干扰 观测 及 消除 


永 磁 直 线 电动 机 (PMLM) 的 性 能 不 可 避免 地 受到 当前 扰动 大 小 的 限制 。 这 
些 干扰 可 能 会 因 多 种 影响 而 出 现 ， 包 括 负 载 变 化 ， 因 长 时 间 使 用 后 系统 参数 的 摄 
动 ， 测 量 噪声 和 放大 器 (尤其 是 当 脉冲 宽度 调制 (PWM) 用 于 放大 器 时 ) 产生 
的 高 频 干扰 ， 或 固有 的 非 线性 动力 学 ， 如 力 波动 和 摩 氛 力 。 通 过 在 测量 系统 中 引 
入 高 插值 电子 器 件 ， 结 合 使 用 更 高 分 辩 率 的 编码 器 ， 只 能 将 定位 精度 提高 到 有 限 
的 程度 。 至 此 ， 当 前 扰动 的 大 小 将 最 终 决定 系统 实现 的 性 能 。 在 本 节 中 ， 精 密 运动 
控制 系统 于 扰 补 偿 这 一 重要 的 问题 得 到 解决 ， 重 点 放 在 使 用 PWM 放大 器 系统 上 。 

基于 对 描述 函数 的 方法 ， 一 个 由 正弦 脉 宽 调 制 驱动 的 直流 永 磁 直线 电动 机 
(DC PMLM) 放大 器 整体 模型 将 被 建立 。 为 了 实际 控制 设计 目的 ， 期 望 系统 模型 
通常 采用 线性 模型 。 该 放大 器 模型 使 用 一 阶 拟 线性 近似 ， 只 考虑 由 放大 器 产生 多 
种 频率 中 的 基本 频率 。 该 模型 是 一 个 永 磁 直 线 电动 机 (PMLM) 的 二 阶 传递 函数 。 

因此 ， 整 体 数学 模型 将 不 可 避免 地 继承 模型 的 不 确定 性 ， 因 而 和 鲁 棒 控 制 方案 
是 必要 的 。 在 本 节 中 ， 提 出 了 一 个 干扰 观测 和 取消 运动 控制 器 的 方案 ， 以 减少 对 
控制 性 能 所 产生 的 影响 。 干 扰 补 偿 器 的 设计 和 控制 比较 简单 ， 直 接 适 合 实际 应 
用 。 全 部 试验 结果 说 明了 提出 的 PMLM 精密 运动 鲁 棒 控 制 系统 方案 的 有 效 性 。 

1. 整体 系统 模型 (PWM + PMLM ) 

在 传递 函数 的 形式 ，PMLM 根据 动力 学 方程 (2. 53) 可 以 描述 为 


P ) = K, 
pmu (S ~ s( Ts +1) 


其 中 , K,=K,/K, 和 7, =M/K, 是 模型 的 参数 。 这 个 模型 的 选择 也 极 大 地 方便 了 
自 校 正 控制 方法 的 使 用 〈 参 见 第 3 章 内 容 ) 。 

高 电压 和 高 电流 PWM 放大 器 混合 封装 的 情况 吸引 了 许多 使 用 传统 线性 放大 
器 的 伺服 驱动 器 设计 者 的 兴趣 。PWM 放大 器 的 主要 优点 对 线性 放大 器 显然 是 电 
能 传送 的 效率 。 一 个 PWM 放大 器 70% ~90% 的 效率 可 以 很 容易 实现 。 高 效率 表 
现 为 较 低 的 内 部 功 耗 和 更 小 的 散热 片 ， 因 此 降低 了 整体 的 物理 尺寸 。 也 可 以 使 用 
PWM 放大 器 仿真 线性 恒定 电压 放大 器 或 线性 便 流 放大 器 ， 两 者 比 线性 放大 器 都 
有 更 高 的 效率 水 平 。 

设计 中 所 关注 的 PWM 放大 器 是 一 个 正弦 脉 宽 调 制 与 双 极 性 开关 ， 它 采用 三 
角 载 波 。 这 个 PWM 放大 器 将 正弦 信号 (可 以 是 D/A 转换 器 的 输出 ) 转换 到 可 
变 占 空 比 的 脉冲 序列 。PWM 输入 控制 脉冲 序列 输出 的 占 空 比 ， 每 个 周期 开通 关 
闭 一 次 。 当 需要 输出 高 的 脉冲 时 ， 占 空 比 将 接近 100% 。 图 2. 37 所 示 为 PWM 放 


(2. 107) 
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大 器 的 基本 结构 。w, 的 模拟 输入 进行 调制 ， 而 wx。 是 一 个 脉冲 串 ，vu EE 
振荡 器 提供 PWM 开关 频率 (或 载波 频率 ) 。 桥 驱动 电路 由 比较 器 构成 ， 它 比较 
输入 信号 和 三 角 载 波 w 产生 的 脉冲 序列 触发 OF, HOP 2. 38 所 示 。 开 关 时 
刻 由 两 波形 的 交叉 点 决定 。 





























图 2.38 脉 宽 调制 信号 


H 桥 的 MOSFET (S,, S,, S 和 S) 只 是 充当 开关 。 门 控 信号 的 时 间 
(TTL), u, 对 角 线 集合 控制 MOSFET 开启 和 关闭 , BM S. S, FF, S, MS; 关 
闭 ， 反 之 亦 然 。 由 于 wi 的 变化 从 最 小 到 最 大 , we 占 空 比 变化 从 0 到 100% ，ws 从 
100% 到 0 变化 ， 反 之 亦 然 。 差分 电压 u,, -us 与 脉冲 序列 uw 有 相同 的 波形 ,但 
它 有 电动 机 额定 电压 幅 值 。 这 个 简单 的 电压 放大 功能 的 另 一 个 好 处 是 PWM 放大 
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器 为 线性 放大 器 提供 了 高 电压 。 

脉冲 序列 输出 端口 A 和 了 B 可 以 直接 连接 到 电动 机 ， 由 于 电动 机 本 质 上 是 一 
个 低 通 滤 波 器 ， 将 第 出 高 次 谐 波 的 脉冲 电压 ， 从 而 产生 一 个 模拟 信号 。 不 过 ,还 
是 建议 将 LC 滤波 器 连接 到 放大 器 模块 或 内 置 LC 滤波 器 。 该 滤波 器 用 于 EMI 
( Electro-magnetic Interference， 电 磁 干 扰 ) 消除 和 EMC ( Electro-magnetic Compat- 
ibihty， 电 磁 兼 容 性 ) 。 如 果 没 有 滤波 器 ， 电动 机 的 长 电缆 带 有 高 压 开关 脉冲 ， 并 
具有 天 线 特 性 。 如 果 外 部 滤波 器 是 必需 的 ， 经 验方 法 是 设置 LC 滤波 器 的 转角 频 
率 (或 截止 频率 ) 低 于 PWM 开关 频率 的 10 ELK, 

在 试验 平台 系统 ， 线 性 驱动 器 是 由 具有 20kHz 三 角 载 波 的 正弦 PWM ( 双 极 
开关 ) 驱动 的 。 注 意 到 PWM 输出 内 含 的 谐 波 频 率 ， 会 影响 定位 精度 。 在 许多 控 
制 性 能 要 求 不 多 的 运动 控制 系统 中 ，PWM 放大 器 动态 特性 被 忽略 ”只 有 PMLM 
被 建 模 。 然 而 ， 当 性 能 要 求 越 来 越 严 格 ， 有 必要 直接 考虑 与 PWM 放大 器 相关 动 
SF., Ak, PWM 放大 器 模型 将 基于 描述 函数 方法 推导 。 根 据 PWM 放大 器 
和 PMLM 组 成 的 总 体 模型 设计 控制 器 。 

作为 一 个 典型 的 描述 函数 分 析 ， 假 定 正弦 波 输 入 到 PWM 放大 器 给 定 如 下 

u;(t) =u,,coswt (2. 108) 
这 也 是 PWM 放大 器 的 一 个 自然 输入 ， 因 为 通常 通过 D/A 转换 器 直流 输入 由 控制 
器 转换 成 一 个 适当 幅度 的 正弦 波 。PWM 输出 将 由 包括 基 频 ww ( 见 图 2. 39) 在 内 
的 一 个 脉冲 序列 构成 。 利 用 傅 里 叶 分 析 ， 这 个 周期 信号 可 以 分 解 成 等 价 的 正弦 基 
波 和 高 次 谐 波 ， 即 


u(t) = > u,,Cos(iwt + 9;) (2. 109) 
其 中 ，w 是 依 里 叶 系 数 对 应 的 第 i 个 谐 波 。 


20kHz ul t)}=uy, cos(wtt P,) 
u | tup2COs(2wt+ Pa) 


Uy = Hip COS 
PWM We 
1 放大 器 ` t 


Up= Up ;COS(Ct+t P) 


{=} AA 


图 2.39 PWM 放大 器 描述 函数 分 析 





Uj = Him COS 





+ 
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如 果 假 定 高 次 谐 波 会 通过 自然 筛选 低 通 的 PMLM (滤波 假设 ) ， 只 有 基本 频 
率 时 ， 则 w(t) =u,,cos(wt +, )o 
该 PWM 放大 器 的 频率 响应 近似 赋予 通过 


1C(jw) | =" (2. 110) 
arg G(jw) ] =Q, (2.111) 
这 可 以 认为 是 线性 的 增益 ,使 
un _ Ap 
频率 响应 可 转换 为 有 延迟 (9,/o) 的 参数 传递 函数 
G(s) = ee (2. 112) 


m 


通常 ，o 小 ， 以 致 延误 期 限 可 被 忽略 。 

图 2. 40 所 示 为 由 PWM 放大 器 驱动 PMLM 的 整体 模型 。PMLM 可 以 表示 为 三 
阶 传递 函数 ， 而 PWM 放大 器 可 以 描述 为 其 中 的 一 个 常数 。 放 大 器 在 这 里 作为 肪 
冲 发 生 器 PWM。 门 控 信 号 的 产生 ，zx 会 触发 吾 桥 ， 使 脉动 信号 放大 。 电 源 电子 
电路 输出 产生 模拟 信号 用 来 驱动 PMLM。 


Ig =320V 
s 320 (直流 ) App=640V 










k 
Pram =z 元 一 一- 
s(s?+a stay) 


图 2.40 PMLM 整体 模型 


2. 设计 扰动 观测 器 

在 鲁 棒 控制 方案 中 采用 干扰 观测 器 ， 减 少 了 控制 性 能 对 干扰 的 敏感 性 ， 更 尤 
其 是 对 PWM 放大 器 的 高 次 谐 波 、 波 动力 和 负载 的 变化 等 形式 干扰 的 影响 。 图 
2.41 所 示 为 有 干扰 观测 器 的 控制 系统 ， 由 干扰 观测 器 推导 出 实际 干扰 的 估计 ， 
用 以 补偿 扰动 的 影响 。r，u，, £, x, 和 4d 分别 表示 参考 信和 号、 控制 信号 、 测 量 
噪声 、 系 统 输出 及 实际 和 估计 的 扰动 。 干 扰 观 测 器 如 图 2. 41 中 虚线 框 所 示 ， 其 
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对 干扰 的 估计 基于 输出 x 为 和 控制 信号 w，P 表示 实际 系统 。P, 表示 等 价 系统 ， 
ABT HEA 


Co 


P 





(2. 113) 


=i; m-l -1 
”CS te +a, ) 18 tan) 


HH, P, 是 一 个 m 阶 延 迟 系统 ， 并 在 原点 有 一 个 极点 。 这 里 使 用 三 阶 模型 ， 即 
l=1, m=2, M 


K 


___*, 
Pe (2. 114) 





图 2.41 有 干扰 观测 器 的 控制 系统 


干扰 观测 器 结合 了 标 称 系统 的 逆 ， 因 此 需要 低 通 滤波 器 FF 用 来 建立 并 实现 

适当 的 干扰 观测 器 。 对 于 二 阶 模型 已 ， 选 择 一 个 合适 的 滤波 器 为 
A 

F(s) =g +fis th 
高 阶 观测 器 可 用 于 提前 预测 干扰 的 发 生 。 为 说 明 ， 只 采用 反馈 控制 器 C 设计 ， 
通常 是 在 这 方面 参照 等 价 系统 P,。 如 前 面 几 节 中 描述 的 其 他 的 控制 单元 也 可 以 
使 用 。 干扰 估计 被 添加 到 整体 输入 ， 以 消除 干扰 的 影响 。 因 此 ， 这 个 功能 类 似 于 
前 馈 补 偿 ， 并 可 以 改善 抗 干扰 的 瞬 态 性 能 及 稳 态 运 行 的 性 能 。 

观测 滤波 器 下 带宽 内 ， 图 2. 41 中 的 干扰 观测 器 控制 系统 基本 上 接近 了 无 干 
扰 等 价 系统 。 这 个 观察 可 以 更 清晰 地 看 到 ， 通 过 将 图 2. 41 转化 为 一 个 滤波 器 型 
两 自由 度 等 价 控制 系统 ， 如 图 2. 42 所 示 。 图 2. 42 所 示 的 干扰 观测 器 相当 于 额外 
干扰 补偿 器 (C6,)， 接 通 了 快速 内 环 。 因 此 ， 可 以 认为 ， 补 偿 内 环 从 而 基本 上 
构造 了 一 个 没有 扰动 的 等 价 系统 ， 因 为 它们 已 被 Cu 补偿 。 

可 以 证 明 





(2.115) 


C =E P; (2.116) 
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图 2.42 图 2.41 的 等 价 系统 


对 于 P, 和 F 的 选择 ， 可 以 得 出 
C= +) (2. 117) 
obsv K, (s +f) . 

因此 ， 通 过 关于 天 和 也 的 f AA 的 适当 设计 ，C, 可 以 看 做 是 超前 /滞后 
补偿 。 

该 扰动 观测 可 以 以 许多 方式 进行 设计 。 一 个 可 行 方法 给 出 如 下 : 

1) 确定 的 等 价 模型 (BIK, 和 7,)， 在 此 基础 上 外 回路 控制 器 Cr 的 设计 可 
以 达到 理想 的 指令 响应 。 如 果 Cr 是 一 个 PID 控制 器 ， 许 多 设计 方法 可 供 选 择 。 

2) 调整 干扰 补偿 器 (Coan) 的 上 往来 满足 鲁 棒 性 和 抑制 干扰 的 要 求 。 该 
系统 的 灵敏 度 函 数 和 系统 传输 功能 可 以 独立 设置 。 当 设 定点 跟踪 有 严格 要 求 和 干 
扰 抑制 这 些 两 者 之 间 相 互 冲 突 时 ， 独 立 设置 的 功能 是 非常 有 用 的 。 

3) 进行 模拟 和 调整 ， 直 到 性 能 可 以 接受 。 

3. 试验 

PWM 放大 器 具有 三 角 载 波 ， 峰 峰值 为 10V。PWM 输出 范围 为 -3 ~ +5V。 
脉冲 触发 电 桥 电路 ， 输 出 -320 ~320V 范围 的 放大 脉冲 电压 ， 用 于 驱动 永 磁 直线 
电动 机 (PMLM) 。 整 体 放 大 器 的 增益 为 

C _2 x 320 - 
10 

将 式 (2.107) 代 人 制造 商 规格 有 关 的 各 种 常数 ， 产 生 一 个 整体 总 模型 〈 标 称 化 
到 pm) 


64 (2. 118) 


_ 6.91 x10’ 

” s(s+136.5) 

实时 试验 结果 如 图 2.43 所 示 ， 具 有 干扰 观测 器 的 控制 器 可 以 实现 小 于 7hm 

的 跟踪 误差 。 该 控制 器 性 能 良好 ， 即 使 将 负载 干扰 故意 引入 系统 ， 如 图 2. 43 方 
WE B 所 示 。 相 比 之 下 , HEA 突出 了 引入 了 负载 干扰 的 前 系统 性 能 。 后 者 控制 


(2. 119) 
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信号 的 变化 没有 反应 在 引入 干扰 的 误差 信号 里 。 换 而 言 之 ,控制 系统 能 够 反抗 外 
部 干扰 ， 使 性 能 没有 显著 影响 。 


误差 /hm 





控制 信号 /V 








时 间 /s 
图 2.43 ”具有 干扰 观测 器 的 试验 结果 


为 了 进一步 说 明 干 扰 观 测 器 使 性 能 增强 ， 没 有 干扰 观测 器 的 试验 效果 如 图 
2. 44 所 示 。 负 载 干扰 故意 输入 该 系统 的 影响 清楚 地 体现 在 误差 信号 中 ， 如 图 
2.44 方 框 B 所 示 。 图 2. 43 和 图 2. 44 之 间 的 比较 显示 ， 该 干扰 观测 器 的 使 用 不 
仅 有 效 地 减少 跟踪 误差 ， 而 且 对 消除 或 减少 内 在 力 波动 是 有 用 的 。 














误差 /um 期 望 轨迹 /X105um 
` 
= = N 








0 3 4 6 8 10 
a) 
20l 
0 
~20 
-40 e 
0 2 4 6 8 10 
b) 
> 20 
ey 
Spada pL tA al ind 
m o 
= Pind nila beta Mi 
W -20 





时 间 /s 
c) 


图 2.44 没有 干扰 观测 器 的 试验 结果 
a) 期 望 轨 迹 b) RÆ c) 控制 信号 
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2.2.9 和 鲁 棒 自 适应 控制 


鲁 棒 自 适应 控制 系统 包括 控制 器 、 性 能 指标 及 自动 增益 调整 算法 ， 调 整 机 制 
使 用 控制 信号 、 系 统 输出 和 性 能 测量 ， 不 断 调整 控制 参数 ， 以 提高 系统 性 能 。 系 
统 可 能 是 非 线 性 或 时 变 的 ， 为 系统 需要 在 整个 工作 范围 内 自动 优化 性 能 指标 是 自 
适应 控制 的 主要 目标 。 这 是 使 用 固定 控制 律 无 法 实现 的 。 纯 自 适应 控制 的 性 能 关 
键 在 于 如 何 从 系统 信号 有 效 准 确 地 引 和 人 隐 含 或 明确 的 信息 ， 系 统 性 能 是 否 具有 重 
棒 性 ， 可 以 接受 参数 和 非 参数 模型 的 不 确定 性 。 自 适应 控制 可 能 需要 增强 ， 以 滑 
模 控制 输入 实现 对 不 确定 参数 和 非 参数 模型 进行 误差 鲁 棒 控 制 。 自 适应 控制 提供 
了 实际 系统 模型 参数 的 适应 性 ， 同 时 滑 模 控制 可 以 有 效 处 理 非 参数 模型 的 残余 
误差 。 

1. 控制 设计 

在 这 个 方案 下 ， 重 棒 自 适应 跟踪 控制 方案 给 出 了 PMLM 状态 跟踪 轨迹 。 控 
制 有 一 个 附加 的 滑 模 控制 输入 ， 以 补偿 非 参数 模型 的 残余 误差 。 滑 模 控 制 输 入 增 
益 自 适应 调节 估计 建 模 动 态 线性 的 边界 。 自 适应 控制 算法 如 图 2.45 所 示 。 






be wet sen(i)+f, sgn(x)x+ 
A, coswxtA 7 Sinext/sgn( sy) 








图 2.45“ 自 适应 控制 算法 
方程 (2.57) 可 以 简化 成 为 更 适合 开发 的 自 适应 控制 方案 。 令 


a= 
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并 定义 任何 其 余 的 未 建 模 动态 已 .， 因 此 


g aË HU F piein — Frope 一 iood — Fra (2. 120) 








假设 负载 力 范围 7 
\Fiaa(t) | <fiy Vi>0 (2. 121) 
AR (2.57) 具有 6 =2，F 摩 擦 可 写 为 同等 形式 
Frc = [f+ (ff)e RF” +flxl]sgn(%) 
其 中 , ff 和 六 被 假定 为 常数 。 由 于 0 <。 E? <1， 斯 特 里 贝克 效果 是 有 界 
tah, BCL -大 )e “1<fr。 波 动力 描述 为 负载 位 置 的 正弦 函数 ， 具 有 A 
期 和 4, 振幅 ， 即 


Jopie =A,sin(wx +p) =A,cos(wx) +A,sin( wx) (2. 122) 
其 中 ， A,, œ, 9, An, An KER 0 
定义 跟踪 误差 
e(t) =xa(t) —x(t) (2. 123) 
e(t) =x;(t)-2(t) (2. 124) 


EH, xa Als, 分 别 为 是 理想 的 位 置 和 速度 。 为 了 实现 鲁 棒 跟 踪 控 制 ， 滑 动 面 定 
义 为 
s = A | eCr)dr + Aze(+) +è) (2. 125) 


EP, A, A, 的 选择 为 A +A°A +A, 是 幸 尔 维 茨 多 项 式 。 
这 里 另 一 个 误差 度量 ss (七 定义 为 


sa(1) =s(t) —8sat(s(t)/8) (2. 126) 
其 中 ，sat(. ) 是 一 个 饱和 函数 ， 定 义 为 
sat(x) =|" Ixi <I (2. 127) 
sen(x) Ixlzel 
函数 5, 有 以 下 有 用 的 属性 
1) 如 果 1s1 <6, Wis, =s, =0。 
2) 如 果 ls1 >6, 则 ss。=s 且 | ss1=1s| -6。 


3) sasat(s/6) = ls 1。 
因此 ， 这 个 问题 是 设计 一 个 控制 律 x(t) ， 即 任何 :>0 时 确保 跟踪 误差 度量 5 (2) 
在 预先 确定 的 边界 8 内 。 
以 下 控制 器 构造 了 方程 (2. 120) 非 线性 系统 
u= -âk — bu, +fisgn(x) +f,sen(x)%x +A,cos(wx) + 


A, sin( wx) +fsgn(s,) (2. 128) 
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其 中 ，2 和 记分 别 是 e AD 估计; ARES 的 估计 ; J, RES, 的 估计 ; 4 和 4 的 
分 别 代表 4 和 42 的 估计 ; 了 是 fy +fiw 的 估计 。u, 是 一 个 额外 的 控制 ， 给 出 如 下 

u, = —A,e-A, e -%, -K,s, (2. 129) 
微分 s(t) 并 应 用 式 (2.128) 的 控制 律 ， 该 系统 动力 学 可 以 写 为 滤波 跟踪 误差 形式 


s+K,s, 


=(-@xz- bu, + f ,sen(%) + f sgn( a) x + A ,,cos( wx) + A ,sin( wx) - 


fsgn(ss) + (F. -f)e $? + Figg )/b (2. 130) 
其 中 ， a =a-4, b =b-5, F=f -F f,=f,-£, An =A, - Ân, Ay = 
A, -Ano 
参数 更 新 律 现 指定 为 
a= -k, xs, (2. 131) 
b= —kyu.s, (2. 132) 
$. =kysen(a) sq (2. 133) 
fi, =hyisen( x) 5, (2. 134) 
A, =k,,cos(wx)s, (2. 135) 
An =k, sin(wx)s, (2. 136) 
f =klsal (2. 137) 
2. 收敛 性 分 析 


下 面 给 出 的 定理 确定 了 控制 器 跟踪 误差 收敛 性 。 

定理 2.3 考虑 方程 (2. 120) 的 非 线性 系统 和 xs，xs Mx, 提供 的 跟踪 期 望 
轨迹 的 控制 目标 。 由 方程 (2. 128) 与 方程 (2.131) ~ 方程 (2.137) 控制 律 将 
确保 系统 状态 和 参数 一 致 有 界 ， 而 且 *( 蕊 渐 近 收 敛 到 预先 确定 的 边界 5。 

证 明 : 首先 选择 李 雅 普 诺 夫 函 数 V(t) ， 定 义 为 





olp, lz, lg, lg, i ge, bp 
V(t) =p bss +5, a tap? opt EARE Ant 
Age ly 
2b, 4 A tI (2. 138) 


其 中 ， 了 =f-f, f=fu +fw。 注 意 到 边界 层 外 ，;。 = 5 ， 而 边界 屋内 的 s。=0， 可 
， 以 得 出 
1 ~ 


= . ~ ~ ly? 1 > 1 全 
V=b ssi +7 Taty? b +a fet ha ft An 


rl 


mei 


rl 
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~ 1 ~ nw 
+E Aad atg S 
= -Kbs -[ @x + bu,- f ,sgn(x) - f, xsgn(x) - A,cos(wx) 
-4 asin(wa) Jsa + Cf, 一 所)e G4 2 sen(sy) + F oad 


Fogh iog AnA n 


= 


~ 


< -K,bsi - [ ax + bu, -f ,sgn(x) — f, xsgn(x) - A ,,cos( wx) 


一 A ,sin( wx) ]s, + [fu +f -f] ls, | +a a 


1>> 1% 7,17 ly ~ ils 7 1¢ 
tee b ft? Ftp Ada tp dada edi 
= -K,bs, -[ ax+ bu, -f o) F, Lsgn(%) 一 A ,,cos( wx) 
~; lee 144 144 
-å 2sin(wx) ]sa +f [ssl -5 Tê- bb -m/f 
-L3 å LAA,-177 (2. 139) 
ka rl?*rl ko mi k; 
替代 方程 (2. 131) ~ 方程 (2. 137) ， 给 出 表达 式 
Ve —K,bs: (2. 140) 


由 于 45>0， 所 以 Y<0。 这 意味 着 s。，6, b, Fs Fo An, Ap MPR t RAR, 
为 了 证 明 跟踪 误差 有 界 ， 有 必要 证 明 x 和 x 有 界 。 
定义 
a, = [x - x)dr (2. 141) 
MÈ (2.125)， 可 以 得 出 


To 0 1 Oo 0 
l-a alls] hh (2.142) 
HFA, A 的 选择 ， 使 得 A* +AA +A, 为 赫 尔 维 芯 多 项 式 ， 上 述 方程 的 自由 系 
统 是 渐 近 稳定 的 。 加 上 ss 有 界 ， 意 味 着 x 和 x 有 界 。 
RERE, OAR), APSO 由 公式 (2.130) Be. HE, - 
fe 0? ，Fiw 和 系统 参数 有 界 ， 这 意味 着 ,方程 (2.130) 右边 是 有 界 的 ， 
从 而 ;也 是 有 界 的 。 方 程 (2. 140) 和 正定 的 了 进一步 有 
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im[ - V(r)dr = V(0) 一 TimY( < œ ` (2. 143) 
通过 对 巴尔 巴 拉 特 (Barbalat) 引 理 的 引用 
limV() =0 (2. 144) 


应 用 公式 (2.140) 又 意味 着 
lims, =0 (2. 145) 

证 毕 。 

TER K, 实际 是 标准 的 PID 控制 。 原 则 上 ， 任 何 现 有 的 PID 调整 方法 都 可 以 
用 来 调整 和 确定 A, A 和 KK,。 初 步调 整 可 以 是 粗略 的 ， 因 为 系统 性 能 利用 自 适 
应 单元 可 进一步 改善 。 

为 了 实现 高 精度 跟踪 ，6 应 选择 较 小 。 然 而 ， 小 的 8 可 能 导致 控制 抖动 。 因 
此 ， 应 该 在 期 望 跟踪 误差 和 容许 输入 不 连续 之 间 取 折 中 。 

3. 试验 

使 用 自 适应 控制 实现 的 跟踪 性 能 和 期 望 轨迹 如 图 2. 46 所 示 。 如 图 2.47 所 
示 ， 采 用 纯 PID 控制 时 ， 最 大 跟踪 误差 为 1 5pym， 相 比 自 适应 控制 的 最 大 误差 能 
低 于 8hm。 20 
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图 2.47 基于 PID 控制 器 的 跟踪 性 能 


2.2.10 和 迭代 学 习 控制 


由 PMLM 执行 的 运动 自然 重复 时 ， 和 迭代 学 习 控 制 (ILC) 对 PID 反馈 控制 器 
来 说 ， 可 作为 一 个 简单 的 无 模型 的 学 习 提 高 。 该 前 馈 项 的 主要 目标 是 抗拒 外 来 扰 
动 ， 以 补偿 在 2. 1 节 中 介绍 的 非 线性 ， 否 则 会 限制 简单 反馈 控制 系统 的 精度 。 
ILC 利用 任务 实现 的 重复 性 质 取 得 经 验 ， 以 弥补 系统 的 模型 不 好 或 知识 不 完整 和 
当前 扰动 的 影响 。ILC 最 近 的 综述 可 以 参考 摩尔 (Moore) 1998 年 的 论文 。ILC 
基本 上 是 一 个 基于 内 存 的 方案 , 需要 存储 跟踪 的 误差 和 以 往 重复 控制 的 效果 ， 以 
构造 当前 周期 的 控制 工作 。 因 此 ， 离 散 时 间 的 实施 是 必要 的 。 有 两 种 常见 的 ILC 
更 新 算法 ， 一 个 是 P 型 算法 ， 只 考虑 跟踪 误差 作为 学 习 输 入 ; 一 个 是 DD 型 算法 ， 
需要 跟踪 误差 的 微分 (Longman 1998 年 ) 。 对 于 实际 应 用 ，P 型 更 新 算法 已 被 实 
践 证 明 是 更 稳健 更 有 效 的 算法 。 

图 2. 48 所 示 为 这 种 控制 方案 的 广义 方块 图 ， 图 中 的 反馈 控制 器 用 来 稳定 系 
统 ， 而 ILC 前 馈 控制 器 是 在 前 面 周 期 基础 上 加 强 下 一 个 周期 的 性 能 。 

任务 假定 是 要 在 一 个 有 限 的 时 间 7 内 反复 执行 。 在 第 i 次 重复 ， 对 期 望 输出 
轨迹 a(t), PER u(t) 作 用 下 跟踪 误差 是 e (5) 。 到 系统 的 控制 输入 是 一 种 前 馈 
输入 w(t) 和 反馈 输入 u(t) SE BRA. u) 基于 控制 效果 和 以 前 重复 的 跟 
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踪 误 差 来 更 新 ， 一 般 可 以 描述 为 
w(t) =£ (u(t) ,ei1(t)) (2. 146) 
RF, 是 待定 的 学 习 算 子 。 


/次 重复 运算 。 








en 








uft ) 


图 2. 48 控制 方案 的 广义 方块 图 





1, 预备 知识 及 问题 描述 
考虑 下 面 的 离散 时 间 不 确定 非 线 性 时 变 系 统 ， 要 反复 完成 既定 任务 。 
one =f(y; (4) ,t) + By, (1) ,t)u,(t) + w(t) 
x(t) =C(t)y;,(t) +u(t) 
其 中 ,i 表示 第 i 个 系统 的 重复 操作 ，: 是 离散 时 间 指 标 ， 且 te [0,N]， 这 意味 
着 te 10,1,…,N} ; y(t) eR", w(t) eR” Mx) eR’, PANERA, BRA 
Al RSE, C(t) e R “代表 一 个 时 变 和 矩阵; 函数 人 O, o) R x[0,N] eR 
AIBC: , +): R x[0,N] >R" 是 i 关于 x 的 一 致 全 局 李 普 希 兹 (Lipschitz) K 
数 ， 即 Vie [0,N] ,Vi, IRR k Aka, EE 
AACD || <A || Ay (2) |l | AB; (£) || <p || Ax: (t) | (2. 148) 


(2. 147) 


其 中 

Aft) ASOC) st) -fia (E) t), ABC) ABC; CE) -BO (2),2), 
Ay,(t) Dy (t) -xia 00; w(t) u (O ERAR WERA R AATA E ER 
b, 和 b,， 定 义 为 

i bA sup wC) bA sup uC) || Vi (2. 149) 
本 书 使 用 的 范 数 的 定义 为 
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_ _ n 
lol = malal NGI = max( De!) 


其 中 , vs [n, e n] 是 一 个 向 量 ，G = [glnan AERE. A h 
误差 (1) Ax,(t) —2,(t), JEP x, (1) 是 给 定 的 期 望 输出 轨迹 ， 这 是 可 实现 的 ， 
即 给 定 一 有 界 的 x,(1t) ， 存 在 一 个 唯一 的 有 界 期 望 输入 ws(i) ,te [0,N] ， 使 得 当 
u(t) =u,(t), KASAM —A ERA y, (1) WE 
pee =f(ya(t) ,1t) + B(xs(t) ,t) ut) Of, + Buus 
x(t) =C xat) AC(t)y, 
记 期 望 控制 w RIA b, Asup, com ll ualt) ‖。 从 任意 连续 初始 控制 输入 uy (1) FF 
始 ， 获 得 下 一 个 控制 输入 u(t) 和子 序列 [u(t) 1i=2,3,…| ， 对 方程 (2. 147) 
系统 使 用 适当 的 学 习 控 制 更 新 律 ， 当 有 界 不 确定 性 、 扰 动 和 重新 初始 化 误差 的 出 
BLM}, iro x,(t) a, (t) te" EB i RIL 迭代 时 ， 系 统 方程 (2.147) 的 控 
制 输入 w(t) 是 


(2. 150) 


u(t) =ul(t) +u? (t), (2.151) 
其 中 ,w(t) 来 自前 馈 学 习 迭 代 控 制 器 ,wt (1) 来 自 反 馈 稳定 控制 器 。 反 馈 稳定 控 
制 器 假设 具有 以 下 一 般 形 式 。 
z,(t+1) =h,(z,(t)) +4,(2,(t) e,(t) (2. 152) 
u; (t) =h, (z(t) ) +Hy(z,(t) Jeli) (2. 153) 
EP, z(t) e R“ 是 反馈 稳定 控制 器 的 状态 ， 具 有 z (0) =0。 向 量 值 函 数 h(，): 
R" RFI h, ©): RYOR" 被 设计 为 区 域 有 界 
hz(2)) |] Sbn 2:2) Il lhea) ) || <5, |] 2,€4) 1 
PRISE H, ( ©): R" bo RR H+): RR” 设 定 为 一 致 有 界 ， 即 Vte[0,N]， 
VEG) eR™, | H,(z,(t)) | <by,, | Haz (2)) | <by,0 
上 述 bno bro Omo by 是 正常 数 ， 不 一 定 是 已 知 的 。 使 用 一 个 简单 的 ILC 更 新 
律 ， 即 
wf (t) =u,(t) +Q(t)e,(t+1) (2. 154) 
这 里 Q(t) eR EFIE, WE ILC 确保 收敛 性 。 
进一步 推导 前 作出 以 下 假设 : 
1) 初始 化 误差 的 有 界 如 下 : 
Vte[0,N], Vi, |xa(0) -x:(0) || Sbn: | xa(0) -—x,(0) || 三 pcb +6, 
其 中 ,bc 人 supsero.wi || C4) Io 
2) EREC + )B(. + ) 有 一 个 完整 的 列 秩 Vie[0,N], y(t) eR’. 
3) 算 子 B(，,… ) 为 界 ， 即 常数 bs 使 得 对 于 所 有 i, sup eom || BO), | 
SUP, <j0,07 | B, (t) || <bso 
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4) 期 望 输出 x, (2) ,te [0,N] AER LASER A u, (2) ,te [0,N] 实 现 的 。 
为 了 分 析 提 出 的 辅助 反馈 了 型 ILC 算法 的 鲁 棒 收敛 性 ， 下 面 等 效 无 穷 范 数 的 
和 A 范 数 引 入 了 离散 矢量 h(i)， 50 rity N: 
IAC) | ,人 A sup 2” | hC) |l (2. 155) 


e [0N] 
H+, 4e>1, A >0 或 当 ee (0,1), A <0, 
下 面 的 递 推 公式 ， 可 直接 验证 


Za +a = R + Ze (a,z; +a) (2.156) 


Hp, (z3, z 1i=0, 1, =} 有 两 个 序列 ， 系数 a, a, Mla, 是 互相 关联 的 。 
记 为 
F) Afa -fit) t) ôB, (t) 4B, - B; (t) 

然后 ， 由 方程 (2.147) 和 方程 (2. 150) 可 以 发 现 

&y,(¢+1) =8f,(¢) +6B,(t)u, + B,(t)du,;(t) —w;(t) (2. 157) 
WE (2.157) YOR, A 

l&i I Gk buke) |] BH) |] +b, | eut) |] +5, (2.158) 
从 式 (2.153) 可 以 看 出 


‖ u(t) | <b, aC) | + babe | BC) | + bab, (2. 159) 

且 
(Su) = |] u(t) -= CEE) +u;(4)) S EE) — uF (t) | < | Bue) |] + are) | 
(2. 160) 


方程 (2.158) BH 
I s(t +1) | < (ky + bkg + babnbe) | OC) | + babs, | zi(2) | +bs ll Buz) | 
+ bgb,,b, +b, (2. 161) 
另 一 方面 ， 可 以 观察 到 方程 (2.152) 的 
| zs 人 +1) || Eba aC) || + babe | C2) |] + bab, (2. 162) 
因此 ， 加 入 方程 (2.162) 和 方程 (2. 161) ， 有 
(Oitl) E+ laL | ) SeC oe) | + zt) |) ba |] diz) | +e 
(2. 163) 
其 中 
e å max] k, +b, kg +bgby be + by bosb, + bab, | #1 
eA (bn +b,b,,)b, +b, 
应 用 公式 (2. 156) ， 可 以 得 出 


Il Bi+1) |] + (ttl) | seh Wo + 2,2 "(bs | Bui (7) |} +e) 


(2. 164) 
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一 个 更 简单 的 关系 可 以 由 1 8c(5 1 + alt) |, AH SC) | 得 出 ,注意 下 
IRR: 
1) fel =lcl, YceR, 
2) VIAI >1，sup,iome C =le 
3) Vte [0, N], te [0, M], WR OSN <N,<N, 那么 6h(4) lhs 
| Fh tz) lac 
取 方 程 (2. 164) 的 范 数 和 (1 Al >1) 运算 给 出 了 
HaC) Wha + MCE) Ia Exo +baO( IAI ~") | Buf(t) | +coe (2.165) 
pocan a HET aa gp $=) 
e 一 6 te[0,N] e-l 
为 了 后 续 描述 简洁 ， 使 用 下 面 的 符号 : 
by & sup. | Q(t) | 
pe sap, |In QC) C(E+1)B,Ce) | Vi 
KK 类 的 功能 也 可 以 这 样 定义 。 
天 类 函数 (Inonnou and Sun, 1996) ; 一 个 连续 函数 由 :[0,r] bR* 被 认为 是 
XAJ, Ede K, GR 
1) @ (0) =0, 
2) 小 在 [0, r) 上 是 严格 增加 的 。 
下 面 介绍 跟踪 误差 界 是 不 确定 性 的 干扰 及 重新 初始 化 误差 的 天 类 误差 界 函 
数 。 此 外 ， 根 据 附 加 的 限制 ， 跟 踪 误 差 界 也 可 以 证 明 是 关于 微分 不 确定 性 ， 扰 动 
和 在 ILC 连续 迭代 时 ， 重 新 初始 化 误差 的 天 类 界 函 数 。 
2. 鲁 棒 收敛 性 分 析 
关于 误差 收敛 的 主要 结果 表示 为 定理 2. 4。 
定理 2.4 根据 以 上 预备 知识 及 问题 描述 假设 ， 对 于 重复 离散 时 间 不 确定 时 
变 非 线性 系统 的 方程 (2. 147) ， 在 固定 时 间 间 隔 [0, NT,] 上 给 定 可 实现 的 期 
望 轨迹 xj(t) ， 通 过 使 用 方程 (2.154) 的 ILC 更 新 律 和 方程 (2.152) 及 方程 
(2.153) 的 反馈 控制 器 ， 如 果 条 件 
pel (2. 166) 
被 满足 ， 那 么 ， 对 于 所 有 i 跟踪 误差 c(t), 6u,(t), lt) A 范 数 是 有 界 的 ， 
对 于 一 个 足够 大 | Al, te [0, N], 
by £ lim || dui(t) | <b byob. ,b,) (2. 167) 
b, &lim | Su: (t) || a Sb, (txo bub) (2. 168) 


by A lim | Bi(t) | Sro + bs0( IAL") by + eoê (2. 169) 
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b, Alim | e(t) |] ,<bcb, +b, (2. 170) 
此 外 ， bu, by, bebu, b,, byob K MR, Bb, b, bo Micon, 一致 
收敛 到 零 ， 在 没有 不 确定 性 、 干 扰 和 初始 化 误差 的 情况 下 ， 即 b,, b, oto 
证 明 : 重复 第 (i +1) 次 的 跟踪 误差 是 
ei(t) =x4(t) —xi(t) 
= C(t) R(t) -u(t) ' (2.171) 
第 (i+1) KEZIA, ôu, (0) 由 下 式 给 出 
ôul (t) =u; (t) -Q(t)e(t+1) 
=6u,(t) -O(t) C(t +1) & Ce +1) +Q0(t)u;(t+1) (2.172) 
引用 式 (2.157), (2.172) 可 以 写成 
ôu, (t) =8u,(t) — Q(t) C(t +1) 
[686( +6B,(1)u, +B;(t)ðu; (t) —w,(t)] +Q(t)u;(t+1) (2.173) 
合并 各 项 ， 并 完成 方程 (2. 173) 范 数 运算 ， 有 
|| Suzi. (£) || Sp |] u; Ct) || + bgbc (ky + bks) | Belt) |] +59 (bed, +b,) (2.174) 
根据 方程 (2. 160) 和 方程 (2.159), 方程 (2.174) BA 
|| Buf.) || <p EE) || a | a(t) | + a(t) fl) +e (2.175) 
其 中 ， aAmax|bobc(ks +b, ke) +b, bcp, bap)? „EA [bol bcb, +b,) +b,,b,p] 
通过 采用 公式 (2.165) 的 关系 ， 对 方程 (2.174) BA 范 数 为 
|| Sui. CE) [<p |] SCE) |, tabgOC IAL *) 5) |], +albyo +cos) +e 


(2. 176) 
关于 式 (2. 166) ， 很 明显 ， 一 个 足够 大 1 Al 可 用 来 确保 
p+abs0(1A1 7) Ap<1 (2.177) 
因此 ， 可 以 得 出 
by = lim || 6u/(t) 1， = Aby kosbe) (2. 178) 
ioe =P 


HH, sode talbyo + co ê) MDE (2.165) MA (2.171), 方程 
(2.169) 和 方程 (2. 170) ， 可 以 验证 。 从 方程 (2.165) 可 以 观察 到 
ba Alim( | (0) Ia + laCt) 1 和 oo+bsOCIAI 1)buf+cog (2. 179) 

因此 ， 由 方程 (2. 160) 和 方程 (2. 159) ， 并 参照 方程 (2. 179) ， 可 以 得 出 

b, Alim || du,(t) || x Sbu + max {br ,by,5b¢} ba + bnb, Sb,( bo,b,,b,) (2. 180) 
从 而 验证 了 式 (2.168), Web, RAMS by 6, b Mb, 4iroht, 没有 
不 确定 性 。 在 干扰 和 初始 化 误差 的 情况 下 ， 对 上 =0，1，N，…， 都 将 趋 于 零 ， 
即 当 b,, 6, bYo™0o 
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3. 另外 的 结果 

为 了 有 效 实现 ILC， 应 当 考 虑 下 列 其 他 问题 。 

1) 初始 化 。 作 为 ILC 公式 化 的 假定 之 一 ， 在 每 个 运动 的 轨迹 重复 后 ， 系 统 
必须 重 置 相同 的 初始 状态 ， 因 为 初始 化 误差 将 直接 对 最 后 的 跟踪 性 能 产生 负面 影 
响 。 这 尤其 是 在 PMLM 系统 中 ， 波 动力 随 着 传送 器 位 置 变化 而 变化 。 因 此 ， 关 
键 在 通过 PID 控制 适当 的 初始 化 得 到 正确 的 设 定点 值 。 最 后 重复 的 终端 跟踪 误差 
可 用 于 这 一 更 正 。 

2) 滤波 。 由 于 在 PMLM 系统 只 有 位 移 可 测量 ， 使 用 数值 差分 方法 得 到 速 
度 ， 自 然 噪 声 受 到 放大 。 为 了 减少 噪声 的 影响 ， 位 置 测量 用 的 是 三 次 连续 A/D 
样本 的 平均 值 。 通 过 使 用 一 个 简单 的 有 限 差分 公式 得 到 速度 


z(t) =[x(t) -a(t-1)]A, (2. 181) 
其 中 , t 是 采样 周期 。 为 了 进一步 减少 噪声 的 影响 ， 采 用 一 种 平均 有 限 差分 公式 


x (t) =[«(t) -x(t-N) ]/(N1,) (2. 182) 

其 中 ,WN 实际 选择 时 N=3。 方程 (2.182) 的 简单 方案 与 很 多 先进 和 复杂 的 方案 
等 价 ， 已 在 许多 机 器 人 应 用 中 得 到 了 验证 。 此 外 ， 内 存 预存 储 的 跟踪 误差 可 以 任 
意 控制 。 因 此 ， 非 因果 性 滤波 是 可 能 的 。 

4. 试验 

使 用 ILC 取得 的 跟踪 性 能 如 图 2. 49 所 示 ， 进 行 了 50 次 迭代 。 通 过 学 习 获 得 
的 最 大 误差 为 13um。 这 个 方案 的 好 处 是 PID 反馈 控制 器 不 必 严 格调 整 。 不 过 ， 
这 种 运动 必须 重复 的 性 质 适 用 于 ILC 方案 。 有 关 跟 踪 误 差 (HARMS) 收敛 
曲线 的 学 习 和 迭代 次 数 如 图 2. 50 所 示 。 


ILC+PID(50 次 迭代) 


20 "| 一 一 一 








4 Co 
一 站 


| 
- = a z 
RMS 跟 踪 误差 /um 
SS 名 


位 置 误差 /hm 
è 








0 











© 
= 


a a 


04 06 08 20 30 
BTA /s 和 迭代 次 数 
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伴随 着 自 适应 控制 和 技术 的 进步 ， 现 代 工 业 控制 器 越 来 越 智能 化 。 目 前 市 场 
上 出 现 的 许多 高 端 控制 器 都 具有 自 整 定 和 自 校 正 功能 。 单 调 乏 味 的 手工 调整 不 再 
是 控制 系统 必须 的 部 分 。PID 调节 器 的 作用 已 减少 到 进行 简单 的 规范 和 决策 。 

控制 器 调整 可 用 不 同 的 系统 方法 ,但 是 无 论 它们 的 设计 方法 如 何 ， 以 下 三 个 
阶段 通常 是 适用 的 : 

1) 由 特定 的 控制 输入 产生 系统 扰动 或 闭环 自动 生成 控制 输入 。 

2) 分 析 扰 动 响应 ， 产 生 非 参数 或 参数 系统 模型 。 

3) 在 此 模型 和 某 些 运行 规范 基础 之 上 ， 确 定 控制 参数 。 

控制 器 自 整定 简 而 言 之 意味 着 上 述 过 程 自动 化 ， 因 此 扰动 、 模 型 计算 和 控制 
器 的 参数 选择 都 由 同一 个 控制 器 完成 。 以 这 种 方式 ， 操 作者 的 工作 得 到 了 简化 ， 
因而 他 只 需要 启动 调节 过 程 ， 无 需 亲 自 获 取 或 计算 合适 的 控制 器 参数 。 他 可 能 要 
在 整定 结束 前 给 控制 器 一 些 系统 信息 ， 但 这 些 信 息 将 比 考虑 控制 器 参数 更 为 
简单 。 

本 章 介绍 了 伺服 机 械 控 制 系统 的 继电器 校正 方法 。 这 些 方法 直接 可 与 第 2 章 
所 提出 的 各 种 控制 方案 结合 使 用 。 


3.1 继电器 自 整定 


为 了 确定 控制 方案 ， 标 称 系统 模型 是 必要 的 。 本 节 需 要 考虑 的 是 控制 方案 部 
分 的 标 称 模型 ， 以 便 确定 自 整定 的 方法 。 在 提出 的 各 种 自 整 定 方法 中 ，Astrim 
and Higglund (1995 年 ) 的 研究 工 
作 从 实践 角度 看 ， 可 以 说 是 最 有 吸 
引力 的 。 继 电器 反馈 系统 如 图 3.1 
所 示 ， 利 用 开关 继电器 插 人 控制 回 
路 作为 控制 器 。 有 了 这 项 安排 ， 据 
推测 许多 系统 会 产生 持续 振荡 。 这 
个 推测 在 过 程控 制 系统 的 许多 应 用 中 已 经 得 到 了 实际 的 证 明 。 

由 于 大 多 数 系统 会 表现 出 低 通 特性 ， 输 出 振 葛 将 近似 于 一 个 周期 坟 和 振荡 
幅度 a 的 正弦 波 。 表 示 继 电器 控制 的 信和 号， 方 波 w 通过 健 里 叶 级 数 展开 一 次 谐 
波 ， 该 系统 频率 响应 相应 由 式 (3. 1) 给 出 








图 3.1 继电器 反馈 系统 
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其 中 , 疡 代表 继电器 的 振幅 。 方 程 (3.1) 是 一 个 复杂 的 方程 式 。 通 过 求解 方程 
(3.1) ， 只 要 待定 参数 数目 小 于 或 等 于 2， 就 可 以 从 该 反馈 继电器 约定 来 推 知 系 
统 的 参数 。 这 种 简单 处 理 可 视 为 使 用 频 域 描述 函数 分 析 的 方法 。 振 荡 的 必要 条 件 
是 前 馈 传输 增益 必须 等 于 - 1， 等 价 描述 为 


(TENE = -1 (3.2) 


假设 已 知 传递 函数 C, (s). BAe Ti IR PA AE -1/Na) MG (s) AR 
奎 斯 特 曲线 ， 用 图 解 方程 (3.2)。 交 汇 点 会 特别 提示 存在 一 个 振荡 的 极限 环 。 
振 划 的 周期 和 幅度 由 该 点 频率 响应 参数 给 出 。 常 规 继电器 整定 的 问题 是 某 些 系统 
不 显示 稳定 的 极限 环 振 功 。 这 些 典 型 的 系统 只 有 低 阶 动态 ， 没 有 传输 滞后 。 尤 其 
是 很 少 呈现 出 小 于 - 的 相位 沸 后 的 伺服 机 械 系 统 。 这 或 许可 以 解释 继电器 反馈 
方法 主要 适用 于 过 程控 制 系统 的 原因 。 根 据 频 域 分 析 ， 这 种 方法 看 上 去 很 清楚 。 
方程 (3.3) 为 一 个 标准 的 继电器 描述 消 数 。 


N(a) = 外 (3.3) 


描述 函数 的 负 北 为 DF1 如 图 3.2 所 示 。 图 3.2 him 
还 显示 了 系统 的 奈 奎 斯 特 曲线 ， 是 伺服 系统 
的 典型 曲线 。 在 有 限 的 频率 范围 内 ， 率 奎 斯 
特 曲线 和 DF1 两 者 之 间 并 无 交点 。 

标准 自 整定 方法 带 来 的 男 一 个 缺点 是 这 
项 试验 确定 奈 奎 斯 特 曲 线 只 有 一 点 与 负 实 轴 
相交 。 然 而 ， 这 唯一 的 一 点 可 能 提供 不 了 关 
于 控制 设计 系统 方面 足够 的 信息 。 

为 了 克服 这 两 个 缺点 ， 有 必要 对 传统 的 
继电器 反馈 的 安排 进行 一 些 修 改 。 根 据 图 
3.2, 为 了 极限 环 振荡 发 生 ， 可 能 需要 给 人 负 逆 
描述 函数 引入 相位 角 。 修 改 后 的 负 逆 描述 函 图 3.2 无 极限 环 标准 继电器 
数 DF2 也 描绘 在 图 3.2 上 。 下 面 介绍 引进 这 自 整定 奈 硅 斯 特 图 
一 相位 滞后 的 两 种 可 能 的 方式 。 


3.1.1 延 时 继电器 


继电器 负 逆 描述 函数 〈 频 域 ) 的 相位 滞后 可 能 与 时 域 纯洁 后 相关 。 如 果 工 表 
示 引 进 的 附加 时 间 延 迟 ， 该 负 逆 描 述 函 数 结果 的 相位 角 变 换 可 以 被 证 明 为 w " 工 ， 其 
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H, w’ 表示 该 延迟 继电器 元 件 逆 描述 函数 和 系统 的 奈 奎 斯 特 曲线 之 间 的 交点 频 
率 。 纯 延 时 继电器 的 设置 见 图 3. 3。 | 一 - 

如 果 存 在 一 个 稳定 的 极限 环 振荡 ， 就 
可 以 衡量 振荡 的 期 限 和 幅度 的 。 经 代数 求 
解 方 程 (3.2) 可 以 获得 该 模型 的 参数 。 
加 上 位 置 环 上 进行 的 继电器 试验 给 出 的 二 
阶 模型 为 











图 3.3 纯 延 时 继电器 的 设置 


K, 
G(s) “S(T, +1) 
由 方程 (3.4) 和 方程 (3.5) 得 出 模型 参数 


Ato" 
K, = (3.4) 


_cot(w" L) 
w` 


T = 


P 


(3.5) 
HKH K, =K,/K, 和 Tp =M/K,, FPR K,, K,, M 的 定义 见 公式 (2. 53), 
3.1.2 双 通 道 继电器 整定 


双 通 道 继电器 整定 方法 是 佛 莱 
& (Friman) 和 瓦 勒 ( Waller ) 
(1997 年 ) 首次 提出 的 。 相 位 滞后 
描述 函数 可 分 为 两 个 正 交 部 分 。 沿 
着 实 轴 和 虚 轴 可 以 方便 地 选择 这 两 
个 部 分 。 采 用 这 个 方法 ， 在 传统 继 
电器 回路 ， 并 行 增加 另外 的 误差 积 3.4 ” 双 通 道 继电器 校正 设置 
分 继电器 。 利 用 这 种 方法 ， 可 以 通 
过 选择 合适 的 设计 参数 hh A h, 来 确定 相位 滞后 ， 其 校正 设置 如 图 3. 4 Bra. 1E 
迟 继 电器 的 例子 中 ， 一 个 类 似 的 方程 组 可 获取 系统 参数 设置 


及 = 一 mw Sro T 
4 dhi +h; 























(3.6) 





3.2 摩擦 建 模 使 用 继电器 反馈 


根据 方程 (2. 120) ， 考 虑 到 当前 的 摩擦 和 负载 力 ，PMLM 动态 模型 可 以 描述 为 
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g n TEHE Plo (3.7) 
忽略 了 斯 特 里 贝克 (Stribeck) 作用 ， 摩 擦 力 影响 的 变换 器 运动 可 以 建 模 为 
库仑 和 粘性 摩擦 的 组 合 。 该 数学 模型 可 以 写成 
l Fic = Uf, +f,1%1]sgn(z) (3.8) 
Et, SAS AL SHB RECHREERAR. | 
对 于 独立 于 运动 方向 的 负载 效应 ，Fiws 可 以 描述 为 
Fa=fisgn(%) (3.9) 
累加 摩擦 和 负载 力 ， 一 个 给 定 的 
外 部 干扰 如 下 
F=[f +plxllsgn(x*) (3.10) 
其 中 , f =f +f;, AA =f,。 图 3.5 说 
明了 FF 的 特征 ， 图 3.6 所 示 为 摩擦 影 ” 
响 下 的 伺服 机 械 系统 模型 。 这 一 节 的 
目标 是 使 用 继电器 反馈 试验 估计 下 E 
要 特征 。 

















摩擦 力 





Joad th res 





图 3.6 摩擦 影响 下 的 何 服 机 械 系 统 模 型 


3.2.1 摩擦 辨识 方法 
在 双 通 道 伺服 机 械 系统 继电器 反馈 下 ， 图 3.7 所 示 的 闭环 设置 可 以 等 价 为 图 








图 3.7 双 继 电器 设置 
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3.8 的 配置 ， 组 成 一 个 并 行 继电器 作用 伺服 机 械 系统 的 线性 部 分 。 第 二 反馈 继 电 
器 (FR2 串联 到 一 个 积分 器 ) 必须 以 限定 频率 激发 振荡 ， 因 为 伺服 机 械 系 统 相 
位 响应 很 少 超过 - tr 














图 3.8 等 价 系 统 


并 行 继电器 构造 ( 以 下 称 为 等 效 继电器 ER) 由 反馈 继电器 FRI, FR2 RE 
AMARA PASAT REI SR 组 成 。 于 是 描述 函数 (DF) 近似 直接 适用 于 分 
术 反 馈 系 统 。 

由 反馈 继电器 (Nem) 和 (Nim) 及 内 在 的 系统 继电器 (Nor), AERE 
器 (Neg) 简单 是 单个 DF 的 总 和 ， 即 

Na = Nera + Neg + Nop 
根据 盖 尔 布 (Gelb) 和 范 德 维特 (Vander Velde) (1968) 的 论文 可 得 
Na (a) = 


4h, 


Nig (a) = -j a 


Nala) =i( 2 + uf) 


Nala) =S jE s uf) 


相对 于 DF 分 析 ， 传 递 函数 处 理 线性 系统 更 方便 。w 到 x 的 线性 系统 传递 函 
数 假设 为 


G,(s) (3.11) 


-AT 

S ps + 

其 中 天 =1/a 和 7T,=b/a。 根 据 继 电器 的 反馈 ， 解 极限 环 的 振荡 幅度 和 频率 
G,(jw) = - (3.12) 


即 G, Go) 等 于 继电器 DF wt, 


1 
Ner(a) 
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方程 (3. 12) 将 生成 以 下 两 个 方程 
IG, Gw) | = 





1 
ey 
argG, (jw) + arg(Nep(a)) = 一 人 
显然 ， 两 个 未 知 参 数 可 从 这 些 方程 的 解 获得 。 
如 果 h >f,, FEE AE DF 的 负 逆 jim 
大 约 是 一 条 在 复 平面 第 三 象限 原点 的 射 
线 ， 如 图 3.9 所 示 。 该 射线 相对 于 实 轴 的 
角度 取决 于 相应 继电器 hl Ah, 的 幅 值 。 Re 
这 样 ， 一 个 持续 的 极限 环 由 伺服 机 械 系统 
产生 ， 与 工业 设置 的 传统 单 继电器 过 程 更 





为 类 似 。 

注意 hh =0 Ah, >f 的 选择 会 导致 一 
个 双 积分 现象 ， 这 里 继 电 反 馈 没有 获得 持 Niele) 
续 的 振荡 。 7 


通过 改变 hh 和 hh，。， 可 进行 两 个 继 电 
器 试验 ， 从 而 未 知 的 也 ,万 AA 可 以 从 方 
程 计 算 ， 假 设 增益 K, 值 是 已 知 的 或 从 其 
他 测试 估计 得 到 。 参 数 可 以 直接 从 下 面 的 ”图 3.9 修改 的 继电器 负 北 描述 函数 
公式 计算 得 到 





_ 4h, K, 
一 2 
Taw 


T, 


_ wazh 1 一 wah, » 


f= 


Wa, — Wa, 








f=- (天 +f =a) (3. 13) 


— maw, T, w 
HF, w, o, 是 继电器 试验 持续 极限 环 的 振 葛 频率 ; a, Ma, 是 相对 极限 环 的 幅 
值 ， hi 和 .分别 是 在 第 一 个 试验 中 所 用 的 继电器 FRI 和 FR2 的 振幅 ; ha 和 
h, :是 在 第 二 次 试验 使 用 继电器 对 应 的 振幅 。 


3.2.2 模拟 


为 了 说 明 fi Af, 通过 继电器 方法 估计 的 准确 性 ， 下 面 给 出 一 个 念 直 例 子 、 
考虑 过 程 : 


G,(s) = (3. 14) 


10 
s(0. 2685s +1) 
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fi =0.5 Alf, =0.01, 在 第 一 个 试验 中 ， 继 电器 参数 选择 在 h =2 A h =1.5, T, 
是 正确 地 确定 为 7, =0.265。 在 第 二 次 试验 中 ， 参 数 选 为 h =1 AA, =0.7。f 和 
是 正确 地 确定 为 h =0.5104 和 =0.0065。 和 两 个 试验 相对 应 的 极限 环 振荡 如 
图 3.10 #13. 11 所 示 。 


2 


<0 
-1 
-2 
0 0.5 1 1.5 2 2.5 3 3.5 4 
时 间 /s 
6 
4 
22 
> 
0 
-2 
-4 
0 0.5 1 15 2 2.5 3 3.5 4 
时 间 /s 


图 3.10 Sh, =2 AA, =1.5 的 输入 输出 信号 


x o 
-0.1 
-0.2 
0 02 04 06 08 1 12 14 16 ig 2 
时 间 /s 
4 
2 
2 0 
> 
-2 
-4 
0 0.2 0.4 06 08 1 1.2 14 1.6 18 2 
BY THI /s 


图 3.11 RA h =1 AA, =0.7 的 输入 输出 信号 


3.2.3 自 适应 控制 的 初始 化 


应 当 注 意 的 是 ， 虽 然 自 适应 控制 器 的 参数 估计 是 自 适 应 的 〈 如 第 2 章 提出 的 
方案 ) ,但 为 了 确保 良好 的 初始 瞬时 特性 和 参数 估计 的 有 效 收敛 ,继电器 试验 提 
供 一 系列 良好 的 初始 值 很 重要 。 下 面 仿真 例子 的 参数 可 以 清楚 地 说 明 这 一 点 。 
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模拟 使 用 的 具体 参数 为 a= -10.5, 6=0.1429, f,=10 和 有 户 =10。 自 适应 
控制 器 需要 跟踪 事先 规定 的 轨迹 。 图 3. 12 所 示 为 初始 值 为 零 的 自 适应 控制 性 能 ， 
即 ，a = = 卢 = 户 =0。 收 敛 速度 慢 ， 并 且 跟 踪 误 差 大 。 图 3. 13 所 示 为 使 用 初始 
值 为 a= -5, b=0.05, f, =6.9979 Alf, =6.9979 的 性 能 。 减少 了 跟踪 误差 ， 收 











X10-4 
3 8 
2 6 
ag | z 4 
nm 0 5 2 
—1 0 
2 -2 
0 0.5 1 1.5 2 0 1 1.5 2 
上 时间/s 时 间 /s 
0.20 > 0.06 
0.05} 
0.15 0.04 
Q M ` 
ti] 0.10 ig 0-03 
# 
0.02 
0.05 
0.01} 
0 0.5 1 1.5 2 0 0.5 1 1.5 2 
时 间 /s 时 间 A 
图 3.12 初始 值 为 零 的 自 适应 控制 性 能 
x10 
8 8 
6 6 
ag 4 z’ 
kiap X, 
0 0 
25 05 1 15 2 % 1 15 2 
时 间 /s 时 间 /s 
7.12 7.03 
710 
708 7.02 
(O) 
xX 7.06 pN 
4 7.04 ig 7°! 
7.02 700 
7.00 
9 
6.98) 0.5 1 1.5 2 6.990 0.5 1 1.5 2 
时 间 A 时 间 /s 


图 3.13 具有 初始 值 a= -5, b=0.05, f =6.9979 ALA =6.9979 的 自 适 应 控制 
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敛 速度 较 快 。 图 3. 14 所 示 为 使 用 初始 值 为 a= -10, b=0.1, f, =9.7971 和 上 = 
9.7971 的 自 适应 控制 。 与 前 两 例 相 比 ， 跟 踪 误 差 和 收敛 速度 都 得 到 了 改进 。 


x105 





3.0 8 
25 6 
20 
W15 = 4 
X 1.0 = 2 
0.5 w 
0 0 
-0.50 0.5 1 1.5 2 为 0.5 1.5 
时 间 /s at i /s 
9.815 9.804 
9.803 
9.810 9.802 
a 9.805 39.801 
a # 9.800 
9.800 9.799 
9.798 
9795995145. 2 97970 “95 is 
时 间 /s nT 


图 3. 14 使 用 初始 值 a= -10, b=0.1, fi =9.7971 M fı =9. 7971 的 自 适 应 控制 


3.3 继电器 振荡 的 最 优 特 征 提 取 


在 许多 继 电 反 馈 的 应 用 中 ， 需 要 在 采样 噪声 的 情况 下 从 周期 性 的 振荡 中 测量 
振幅 、 频 率 和 相位 移 。 受 测量 噪声 的 影响 ， 可 能 很 难 准确 地 提取 这 些 参 数 。 这 些 
参数 直接 或 间接 地 用 于 控制 器 的 设计 。 因 此 ， 可 靠 和 准确 地 识别 在 噪声 影响 下 的 
与 继电器 振荡 相关 的 主要 参数 是 重要 的 。 非 线性 最 小 二 习 (LS) 方法 可 以 应 用 
于 两 阶段 识别 试验 。 

[x(t) lt =ty ,to +7T,,… to + (N, -1)7T| 是 表示 采样 噪声 正 弦 曲线 信和 号 的 一 个 
数据 系列 ， 其 中 ，N, 是 点 总 数 ，T 是 采样 周期 及 6 是 初始 时 间 。 真 实 的 信号 是 

x(t) =Asin( wt +8) (3. 15) 
问题 优化 是 要 找到 一 个 参数 集合 使 性 能 指标 极 小 ， 如 J(4，w，6) 为 
1(4,0,0) = $ [EC +T.) -2C +jT,) T (3. 16) 
这 显然 是 一 个 非 线性 最 小 二 乘 问题 。 这 个 问题 可 以 简化 为 二 阶段 线性 最 小 二 乘 识 
别 问题 。 
1. 第 一 阶段 : 固定 w 
当 w 是 固定 的 , 公式 (3.16) 可 转换 为 线性 LS 问题 。 定 义 
=Asin(0) a, = Acos(@) (3.17) 
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对 于 给 定 的 w， 优 化 问题 就 是 要 找到 4 和 0, 使 J,(4，9) Bh, HP 


ANp-1i 


jy(A,9) = 2 1%( ty +jT,) - a,sin[ w(t +jT,) | = a,cos[ w(t, +jT,) | k 
(3.18) 
这 显然 是 一 个 线性 最 小 二 乘 问 题 ， 可 以 直接 解决 。 
2. 第 二 阶段 ; 改变 w 
参数 优化 过 程 可 以 在 估计 值 附近 的 频率 w 的 范围 内 重复 。 它 可 以 定义 为 
min J(A,@,6) =min{minJ,,(A,6) } (3. 19) 
这 样 ， 可 以 得 到 完整 的 最 优 参数 集 (A, w, 6). 
图 3. 15 所 示 为 从 继 电 反 馈 试 验 嗜 杂 的 振 划 信号 里 提取 的 正弦 包 络 。 








实际 正弦 波 (RMS=1.8939) 


一 一 ”提取 的 正弦 波 /=2.0204 A.hat=2.2201 | theta.hat=75.6667 
4 a 











gg gg 
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2 


图 3. 15 ”噪声 正弦 信号 的 特征 提取 
3.4 试验 


在 本 节 中 ， 试 验 结果 用 来 说 明 该 继电器 方法 的 效果 。 试 验 设置 与 2. 2.9 节 所 
提 类 似 。 

两 个 继电器 试验 都 按照 在 第 3. 2 节 描 述 的 程序 进行 。 确 定 T, =0.073, E 
参数 被 确定 为 =0.238 和 =0.001。 从 两 个 试验 产生 的 极限 环 振荡 显示 在 图 
3. 16 和 图 3.17 中 。 图 3. 16 所 示 为 第 一 个 继电器 试验 的 输入 输出 信号 ,图 3. 17 
所 示 为 第 二 个 继电器 试验 的 输入 输出 信号 。 
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时 间 /s 


0.5 1 L5 
时 间 /s 


图 3.16 第 一 个 继电器 试验 的 输入 输出 信号 


0 00 0.02 003 004 005 006 007 0.08 009 0.1 
时 间 /s 





i i 
0.01 0.02 0.03 0.04 0.05 0.06 0.07 0.08 0.09 0.1 
时 间 /s 


图 3.17 第 二 个 继电器 试验 的 输入 输出 信号 


利用 模型 参数 ，PID 反馈 控制 器 和 前 馈 摩擦 补 偿 器 能 够 较 好 地 初始 化 。 整 体 
控制 系统 如 图 3. 18 所 示 。 由 于 机 械 结构 及 系统 其 他 部 分 具有 固有 和 未 建 模 的 高 
频 动 态 ， 该 未 建 模 高 频 动态 不 应 被 激活 ， 因 此 使 用 小 自 适应 增益 。 

图 3. 19 和 图 3. 20 显示 了 一 个 参考 正弦 剖面 的 跟踪 性 能 ， 对 比 有 和 没有 前 人 馈 
摩擦 补偿 器 的 情况 。 显 然 ， 有 了 摩擦 补偿 器 ， 均 方 根 (RMS) 的 跟踪 误差 值 可 
大 大 减少 ， 从 11.2pm 降 到 1.01pm 左右 。 
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图 3.18 具有 摩擦 预 补偿 器 的 PID 的 控制 系统 
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图 3.19 没有 摩擦 补偿 的 跟踪 性 能 

















02 04 06 0.8 1 12 +14 16 18 2 
时 间 /s 


图 3.20 有 摩擦 补偿 的 跟踪 性 能 
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在 长 行程 、 高 精度 笛 卡 儿 机 器 人 系统 的 各 种 配置 中 ， 目 前 较为 普遍 的 是 H 
型 的 移动 龙门 系统 。 在 这 种 配置 pt? 
中 ， 两 个 电动 机 平行 安装 在 两 边 ， (/ 
同时 串 级 移动 滑动 式 龙门 。 精 密 龙 
门 起 重 机 平台 如 图 4. 1 所 示 。 该 龙 | 
门 系统 有 四 个 子 集 ， 即 X 和 Y 轴 子 “ : 
集 , 平面 平台 和 两 个 正 交 导 引 杆 。 
当 我 们 主要 关注 定位 精度 时 ， 通 常 age 
通过 使 用 直接 驱动 直线 电动 机 和 安 gad SIS 
装 静 压轴 和 承 来 获得 最 佳 性 能 。 另 一 
个 结构 相似 的 H 型 龙门 台 如 图 4.2 所 示 。 它 由 两 个 X 轴 伺 服 电动 机 : SEMs 
MT22G2-10 和 一 个 立轴 伺服 电动 机 :， Yaskawa 公司 的 SGML-01AF12 组 成 。 这 种 
龙门 配置 已 经 在 港口 移动 式 起 重 机 上 使 用 ， 轧 机 和 飞 前 中 也 有 应 用 。 


ao 








图 4.2 另 一 种 结构 相似 的 HH 型 龙门 台 


通常 移动 龙门 平台 设计 提供 高 速 、 高 精度 X、Y 和 2Z 方 向 的 运动 ， 可 以 方 
便 在 平板 显示 器 自动 化 流程 、 印 制 电路 板 制造 、 精 密 计 量 和 电路 装配 等 领域 应 
用 ， 这 方面 的 应 用 需要 高 精度 的 部 件 定 位 。 由 于 双 驱 动 器 的 缘故 ， 平 台 配 备 了 
高 功率 驱动 ， 因 此 如 果 两 驱动 器 适当 的 协调 和 同步 运动 ， 它 可 以 产生 高 速 运动 
且 无 重大 横向 偏 移 。 在 某 些 应 用 中 ， 如 晶片 步 进 器 和 双 驱 动 器 中 也 可 以 用 于 产 
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生 一 个 小 的 8 旋转 运动 ， 而 不 用 任何 附加 的 旋转 执行 器 。 随 着 精密 工程 和 纳米 
技术 的 发 展 ， 系 统 提出 的 要 求 也 日 趋 严格 。 移 动 龙门 台 的 应 用 领域 也 正在 迅速 
扩大 。 到 目前 为 止 ， 几乎 所 有 的 精密 机 械 制造 商都 提供 某 种 形式 的 移动 龙 
门 台 。 

为 了 充分 利用 笛 卡 儿 台 的 配置 潜力 ， 对 于 控制 系统 的 挑战 比较 高 。 除 了 单个 
电动 机 的 精确 运动 控制 ， 它 们 相互 高 效 同步 也 极为 重要 。 由 于 不 同 的 驱动 和 电动 
机 的 特性 ， 龙 门 的 非 均匀 载荷 分 布 、 附 加 末端 效应 及 可 能 时 变 的 热机 械 特性 都 会 
产生 位 置 偏 移 。 高 效 同步 可 以 减少 因 以 上 原因 而 发 生 的 位 置 偏 移 。 特别 是 动态 负 
载 变 化 具有 相当 的 不 对 称 性 质 ， 扰 动 的 形式 需要 恰当 处 置 。 本 章 专门 介绍 移动 龙 
门 的 机 器 人 系统 的 精密 运动 控制 ， 因 为 这 些 方面 已 经 迅速 成 为 重要 的 实现 技术 ， 
它 促 进 了 高 度 准确 运动 过 程 的 实现 。 

本 章 首先 介绍 商业 运动 控制 平台 的 流行 控制 方法 。 这 些 计划 的 功能 和 局 限 性 
将 通过 模拟 和 试验 进行 研究 和 对 比 。 第 一 种 方案 是 设置 一 个 电动 机 为 主 电 动机 ， 
另 一 个 为 从 电动 机 ， 命 令 信 号 只 传送 给 主 电 动机 ， 从 电动 机 只 是 跟踪 主 电 动机 的 
运动 。 第 二 种 方案 则 分 别处 理 两 台电 动机 可 能 不 同 的 动态 特性 ， 为 每 台电 动机 设 
置 了 独立 的 控制 回路 ， 服 从 共同 的 指令 信号 ， 其 配置 与 监控 相似 。 然 而 ， 与 第 一 
种 方案 类 似 ， 该 方案 仍然 没有 一 个 真正 的 轴 间 运动 偏差 反馈 协调 控制 。 第 三 种 方 
案 设计 了 一 个 具有 扰动 增强 观测 器 的 复合 控制 器 ， 用 来 克服 前 面 提 到 的 控制 器 的 
不 足 。 扰 动 观测 器 的 主要 功能 是 充当 一 个 虚拟 传感器 ， 根 据 当 时 的 输入 和 输出 信 
号 及 可 利用 的 系统 模型 ， 来 获得 等 效 扰动 信号 。 这 样 ， 利 用 扰动 的 观测 器 信和 号 ， 
扰动 引起 的 偏差 就 可 以 得 到 有 效 的 自动 纠正 。 

为 了 克服 以 上 方案 中 提 到 的 缺陷 ， 本 章 提 出 一 个 最 新 的 动态 平台 控制 方案 。 
该 方法 采用 了 自 适应 控制 算法 ,算法 基于 平台 的 动态 拉 格 朗 日 模型 。 模 型 足够 详 
细 可 以 解决 主要 控制 问题 ， 而 且 概 括 性 很 强 ， 涵 盖 了 H 型 龙门 平台 的 不 同类 型 。 
此 外 ， 只 有 两 个 基本 参数 (长 度 和 宽度 ) 需要 进行 测量 。 本 章 提供 了 两 个 模拟 
和 试验 结果 ， 用 来 说 明 该 控制 方案 的 相对 性 能 和 竞争 优势 。 


4.1 协调 控制 方案 

正面 介绍 三 个 适用 于 控制 移动 龙门 平台 的 先进 控制 方案 。 前 两 个 方案 是 现 有 
的 工业 运动 控制 器 普遍 应 用 的 方案 。 
4.1.1 经 典 主 /从 方法 


所 谓 的 经 典 主 / 从 办 法 ， 是 选择 一 个 电动 机 作为 两 个 电动 机 中 的 主 电动 机 。 
这 个 主 电动 机 直接 执行 期 望 轨迹 。 主 电动 机 编码 器 也 用 来 作为 主编 码 器 ， 同 时 为 
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从 电动 机 服务 。 因 此 ， 在 本 质 上 ，， 从 电动 机 仅仅 跟随 主 电动 机 的 运动 。 图 4.3 所 
示 为 主 / 从 控制 方案 框图 。 

这 种 方法 相对 比较 简单 ， 它 的 作 
用 就 好 像 一 个 单一 电动 机 在 驱动 运 
动 。 点 动 或 归 位 移动 时 ， 这 种 方法 也 
是 有 效 的 。 命 令 主 电 动机 点 动 或 归 
位 ， 从 电动 机 仅仅 跟着 运动 。 然 而 ， 
该 方法 实现 的 轨迹 跟踪 性 能 相当 有 
限 ， 因 为 主 电 动机 实际 的 轨迹 成 了 接 图 4.3” 主 /从 控制 方案 框图 
受 指 挥 的 从 电动 机 的 轨迹 。 显 然 ， 主 
电动 机 的 实际 轨迹 绝 不 可 能 像 指令 轨迹 那样 平滑 而 准确 。 假 如 实际 轨迹 现在 成 了 
从 电动 机 的 指令 轨迹 ， 从 电动 机 的 实际 轨迹 甚至 会 比 预期 的 偏离 更 多 。 龙 门 系统 
尤其 是 这 样 ， 因 为 两 个 电动 机 可 能 会 有 相同 的 共振 频率 。 主 电动 机 振荡 将 不 可 避 
免 地 被 传送 到 从 电动 机 ， 而 且 被 明显 放大 。 此 外 ， 当 从 电动 机 遇 到 干扰 ， 主 电动 
机 也 将 无 法 获知 这 一 情况 ， 不 能 妥善 解决 这 一 问题 。 


4.1.2 设 定点 协调 控制 


设 定点 的 协调 控制 方法 是 将 两 台电 动机 分 配给 同一 协调 系统 的 同一 轴线 。 一 
个 监控 运动 的 程序 通过 两 台电 动机 驱动 该 轴 ， 两 台电 动机 共享 此 前 为 该 轴 规 划 的 
一 个 相同 的 指令 罗 迹 。 两 个 电动 机 各 自 的 伺服 环 路 要 尽 可 能 地 使 实际 轨迹 与 指令 
轨迹 保持 接近 ， 因 为 它们 都 有 自己 各 自 的 伺服 环 路 。 假 定 两 个 电动 机 具有 紧密 的 
伺服 环 路 ， 此 方法 为 龙门 台 提供 了 电动 机 之 间 的 紧密 而 平滑 的 联系 。 图 4. 4 所 示 
为 设 定点 协调 控制 方案 框图 。 











图 4.4 设 定点 协调 控制 方案 框图 


因为 跟随 指令 轨迹 运动 的 电动 机 缺陷 不 会 直接 影响 到 其 他 的 电动 机 ， 所 以 一 
: 般 情 况 下 这 个 方案 优 于 经 典 主 /从 方法 。 这 种 控制 形式 的 主要 问题 是 由 于 两 台电 
动机 的 动力 差异 或 负 和 苛 差 滞 引 起 的 ， 这 种 情况 下 电动 机 的 位 置 有 可 能 有 相当 大 的 
差异 。 
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4.1.3 整体 协调 控制 
控制 系统 总 体 结构 如 图 4. 5 所 示 。 






Xi dy 


图 4.5 控制 系统 总 体 结构 


控制 系统 总 体 结构 中 ， 前 馈 控制 和 反馈 控制 部 件 的 设计 类 似 于 在 2.2.5 节 中 
介绍 的 内 容 。 一 个 精密 龙门 系统 可 实现 的 性 能 不 可 避免 地 ， 同 时 也 是 非常 明显 地 
受制 于 出 现 的 干扰 量 。 由 于 干扰 在 电动 机 间 均 匀 分 布 ， 可 以 采用 扰动 的 观测 器 来 
强化 复合 控制 器 。 

图 4. 6 所 示 为 控制 系统 中 干扰 观测 器 框图 ， 该 控制 系统 采用 实际 干扰 估计 ， 


从 干扰 观测 器 推算 补偿 干扰 误差 。x;，uw;，d; 和 di 分 别 代表 位 置信 号 、 控 制 信 
号 、 与 i 轴 有 关 的 实际 干扰 信号 和 干扰 观测 器 估计 信号 。uop 代 表 构 成 的 控制 信 
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图 4.6 干扰 观测 器 框图 
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号 ， 用 以 校正 轴 间 偏差 。 它 可 以 是 了 或 PI 控制 器 的 输出 。 如 果 测量 噪声 可 以 容 
忍 ， 可 能 与 滤波 器 一 起 增加 微分 装置 ， 提 供 微分 配置 校正 偏差 。 扰 动 观 测 器 基于 
x 输出 和 控制 信号 u, 来 估计 干扰 。P; 表示 实际 的 系统 。P,,: 表 示 标 称 系 统 。 干 扰 
设计 见 2.6 节 介绍 的 内 容 。 这 种 设计 具有 几 个 重要 的 和 有 用 的 功能 。 首 先 ， 它 采 
用 了 前 馈 部 件 以 实现 快速 响应 。 该 前 馈 部 件 的 模型 包含 了 与 伺服 电动 机 有 关 的 特 
征 ， 包 括 具体 的 摩擦 、 波 纹 和 其 他 可 能 的 阻碍 扭矩 的 特征 。 其 次 ， 最 优 PID 反馈 
控制 器 的 设计 采用 基于 LOR (线性 二 次 调节 器 ) 的 方法 。 这 种 PID 反馈 控制 的 
目的 是 提供 最 佳 的 命令 响应 和 稳定 性 。 如 果 其 他 状态 变量 可 以 测量 ， 全 状态 反馈 
控制 器 可 以 设计 实现 更 多 增强 和 提升 性 能 的 、 类 似 的 设计 规则 。 最 后 ,干扰 观测 
器 是 增强 的 复合 控制 结构 ， 提 供 了 快速 响应 负载 扰动 和 其 他 两 台 发 动机 不 对 称 外 
源 信号 的 作用 。 这 一 功能 尤其 有 用 ， 因 为 负荷 干扰 是 主要 因素 ， 它 影响 着 控制 性 
能 ， 尤 其 在 电动 机 共同 携带 动态 和 不 对 称 负 荷 时 ， 例 如 ， 整 个 龙门 运行 的 附加 体 
服 系统 。 


4.2 仿真 研究 


针对 所 提出 的 三 个 控制 方案 进行 仿真 。 仿 真 在 基于 永 磁 直 线 电 动机 
(PMLM) 的 移动 龙门 台 上 进行 。 仿 真 结果 表明 ,使 用 不 同 的 模型 参数 ， 两 
个 发 动机 就 必然 呈现 不 同 的 动力 性 能 。 此 外 ， 动 态 负 载 变 化 的 仿真 如 图 4.7 


所 示 。 


0.5 ] 1.5 2 2.5 3 


x10° 


负载 变化 


7 
6 
5 
4 
3 
2 
1 
0 
-1 


图 4.7 动态 负载 变化 的 仿真 


4.2.1 控制 任务 


为 仿真 研究 ， 移 动 龙门 台 的 期 望 轨迹 设置 为 五 阶 多 项 式 ， 如 图 4. 8 所 示 。 根 
据 单个 伺服 回路 的 跟踪 误差 和 回路 内 运动 偏 移 来 评价 控制 性 能 。 
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图 4.8 期 望 的 轨迹 


4.2.2 结果 


1. 方案 1: 经 典 主 /从 方法 

双 直 线 电 动机 x, 和 x*,， 分 别 作为 主 从 电动 机 。xi 的 实际 位 置 被 用 作 x, 的 伺 
服 回路 的 运动 命令 信号 。 微 调 这 两 个 伺服 回路 PID 控制 器 ， 来 获得 最 佳 性 能 。 两 
个 回路 的 跟踪 误差 如 图 4.9 所 示 。 最 大 跟踪 误差 约 7wm， 即 沿 整个 轨迹 两 轴 间 的 
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图 4.9 两 个 回路 的 跟踪 误差 
a) 经 典 主 /从 控制 下 x, 轴 的 跟踪 误差 b) 经 典 主 /从 控制 下 x. 轴 的 跟踪 误差 
c) 经 典 主 / 从 控制 下 间 轴 位 置 偏差 
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位 置 偏 移 量 大 约 7pm， 这 反映 了 控制 方案 轴 间 协调 差 。 

2. 方案 2 设 定点 协调 控制 

根据 设 定点 协调 控制 方案 ， 两 轴 各 有 各 的 反馈 控制 回路 ， 但 没有 轴 间 位 置 偏 
差 反 馈 到 每 一 个 控制 器 。 该 案例 使 用 了 在 方案 1 中 用 到 的 同样 的 PID 控制 器 。 结 
果 如 图 4. 10 所 示 ， 单独 的 控制 回路 实现 了 6.2hm 最 大 跟踪 误差 ， 位 置 轴 间 偏 
置 3.2pm。 











位 置 误差 /hm 

















0 05 1 15 2 25 3 
c) 


时 间 /s 
图 4.10 设 定点 协调 控制 的 结果 
a) 设置 点 协调 控制 下 的 x, BRP b) 设置 点 协调 控制 下 的 x, 轴 跟 踪 误 差 
c) 设置 点 协调 控制 下 的 位 置 轴 间 偏 置 


3. 方案 3 整体 协调 控制 

在 本 案例 中 ， 除 了 单独 的 控制 回路 ， 轴 间 位 置 偏 移 用 来 为 协调 目的 而 构造 
一 个 额外 控制 输入 。 结 果 如 图 4. 11 所 示 ， 单 个 控制 回路 实现 的 最 大 跟踪 误差 
为 3.2pm， 轴 间 位 置 偏 移 小 于 2. 7pm, 平均 偏 移 低 于 设 定点 协调 控制 设置 的 
案例 。 

仿真 研究 表明 ， 无 论 是 每 个 轴 的 跟踪 误差 还 是 轴 间 位 置 偏 移 ， 整 体 协调 控制 
明显 具有 更 佳 性 能 。 
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图 4.11 整体 协调 控制 的 结果 
a) 整体 协调 控制 下 x, 轴 有 跟踪 误差 b) 整体 协调 控制 下 x, 轴 跟 踪 误 差 


c) 整体 协调 控制 定位 轴 间 偏 置 





4.3 试验 


试验 采用 两 个 XY 工作 台 配 置 实时 进行 ， 安 装 了 2. 5pm 高 分 辩 率 数字 编码 
器 的 电动 机 x 和 电动 机 y。 其 中 MT22G2 DC 伺服 电动 机 参数 如 表 4.1 所 示 。 一 个 
工作 台 为 移动 龙门 式 配置 ， 两 台电 动机 负载 沿 x 方 向 驱动 。 图 4. 12 所 示 为 该 工 
” 作 台 的 照片 。 另 一 个 工作 台 是 更 为 常规 的 配置 ， 两 台电 动机 各 自 沿 着 x Ay 方向 
驱动 ， 另 一 个 工作 台 的 照片 如 图 4. 13 所 示 。 


表 4.1 MT22G2 DC 伺服 电动 机 参数 








参 。 数 
力矩 常数 
无 刷 电 枢 阻 抗 R 
EMF 电压 常数 到 
BELEL 


MT22G2-10 的 数值 





















0. 10 
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图 4.12 工作 台 照 片 





图 4.13 另 一 个 工作 台 的 照片 


对 于 第 二 个 配置 ， 在 试验 中 的 控制 任务 是 尽 可 能 准确 和 直接 地 执行 XY 对 角 线 。 
这 些 有 关 精 确 的 对 角 线 运动 的 要 求 对 于 机 器 几何 属性 的 校准 是 必 不 可 少 的 。 显 然 ， 在 
此 应 用 中 ， 电 动机 x 和 y 之 间 的 紧密 协调 对 于 移动 龙门 台 要 求 是 同样 重要 的 。 


4.3.1 XY 工作 台 一 一 配置 I 


1. 方案 1: 主 / 从 控制 

试验 结果 如 图 4. 14 所 示 。 单 个 控制 回路 实现 的 最 大 跟踪 误差 是 Sum, Ai 
位 置 偏差 多 达 16um。 在 高 精度 的 应 用 中 ， 此 偏 置 可 能 会 出 现 问题 ， 导 致 无 法 实 
现 所 需 的 运动 精度 ， 以 及 出 现 机 械 校准 问题 。 

2. 方案 2: 设 定点 协调 控制 

试验 结果 如 图 4. 15 所 示 。 单 独 控制 回路 实现 的 最 大 跟踪 误差 为 13pm。 x 
和 x, 两 轴 之 间 的 轴 间 位 置 偏 移 达 到 8pm， 比 主 / 从 控制 条 件 下 的 结果 更 好 。 
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图 4. 14 主 / 从 控制 的 试验 结果 
a) 主 /从 控制 下 的 x; 轴 的 跟踪 误差 b〉 主 /从 控制 下 的 x, 轴 的 跟踪 误差 
c) 主 /从 控制 下 的 轴 间 位 置 偏 移 
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图 4.15 设 定点 协调 控制 的 试验 结果 


a) 设 定点 协调 控制 下 的 xi 轴 的 跟踪 误差 b) 设 定点 协调 控制 下 的 x, 轴 的 跟踪 误差 
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位 置 误差 /hm 
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c) | 
时 间 /s 
图 4.15 设 定点 协调 控制 的 试验 结果 ( 续 ) 
c) 设 定点 协调 控制 下 的 轴 间 位 置 偏 移 


3. 方案 3; 整体 协调 控制 
试验 结果 如 图 4. 16 所 示 。 单 独 控 制 回路 存在 的 最 大 跟踪 误差 为 12pm。 最 大 
两 轴 x, Fl x, 轴 间 位 置 偏 移 只 有 5pm， 三 个 控制 方案 相 比 ， 这 个 结果 是 最 好 的 。 
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图 4.16 整体 协调 控制 方案 的 试验 结果 
a) 整体 协调 控制 下 的 x, 轴 跟 踪 误 差 b) 整体 协调 控制 下 的 x, 轴 跟 踪 误差 
c) 整体 协调 控制 下 的 位 置 轴 间 偏 移 
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4.3.2 XY 图 表 一 一 配置 I 


1. 方案 1: 主 / 从 控制 
试验 结果 如 图 4. 17 所 示 。 单 独 控制 回路 存在 的 最 大 跟踪 误差 为 12pm。 
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图 4.17 主 / 从 控制 方案 的 试验 结果 
a) 主 / 从 控制 下 的 x 轴 跟 踪 误 差 b) 主 / 从 控制 下 的 y 轴 跟踪 误差 c) 主 / 从 控制 下 的 位 置 轴 间 偏 移 


2. 方案 2: 设 定 点 协调 控制 
试验 结果 如 图 4. 18 所 示 。 单 个 控制 回路 实现 的 最 大 跟踪 误差 为 8um。 
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图 4.18 设 定点 协调 控制 方案 的 试验 结果 
a) 设 定点 协调 控制 下 的 x, 轴 跟 踪 误 差 
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图 4.18 设 定点 协调 控制 方案 的 试验 结果 (SE) 
b) 设 定点 协调 控制 下 的 y 轴 有 跟踪 误差 c) 设 定点 协调 控制 下 的 位 置 轴 间 偏 移 


3. 方案 3: 整体 协调 控制 

试验 结果 如 图 4. 19 所 示 。 单 个 控制 回路 的 最 大 跟踪 误差 记录 为 6um。 图 
4.20 中 比较 了 因 使 用 三 个 方案 而 各 自 产生 的 轴 间 偏 移 。 显然， 在 整体 协调 控制 
下 ， 单 个 回路 和 轴 间 位 置 偏 移 的 跟踪 误差 均 有 显著 改善 。 
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图 4. 19 整体 协调 控制 方案 的 试验 结果 
a) 整体 协调 控制 在 x 轴 下 的 跟踪 误差 b) 整体 协调 控制 在 y 轴 下 的 跟踪 误差 
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图 4. 19 整体 协调 控制 方案 的 试验 结果 (BE) 
c) 整体 的 协调 控制 的 位 置 轴 间 偏 移 
90 
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图 4.20 不 同 的 控制 方案 位 置 跨 轴 偏 移 的 RMS 比较 





44 自 适应 协调 控制 方案 


在 前 面 的 内 容 中 ， 提 出 的 控制 方法 实质 上 是 非 参 数 化 方案 ， 或 是 部 分 参数 化 
方案 ， 基 于 线性 主导 的 线性 模型 ， 没 有 明确 对 交叉 轴 效 应 建 模 。 在 要 求 更 严格 的 
应 用 里 ， 沿 工 和 了 方向 的 耦合 和 于 扰 及 可 能 本 质 上 不 对 称 的 负荷 变化 ， 也 许 需 
要 适当 的 处 理 。 在 本 节 中 ， 基 于 物理 模型 设计 了 一 个 自 适应 控制 方案 ， 该 方案 能 
够 在 没有 太 多 的 先 验 信息 假设 情况 下 自 适应 地 估计 模型 参数 。 


4.4.1 龙门 台 的 动态 建 模 


虽然 有 各 种 配置 的 再 型 龙门 台 ， 它 们 中 的 很 多 在 本 质 上 是 相似 的 。 一 个 典 
型 的 龙门 台 可 看 做 三 个 自由 度 的 伺服 机 构 ， 该 机 构 在 图 4. 21 的 示意 图 any 
到 充分 的 描述 。 两 个 伺服 电动 机 携带 龙门 ， 上 面 安 装 负载 (如 工具 ) 的 滑 
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道 / 轨 。 其 中 一 个 电动 机 产生 直线 位 移 x，( 量度 起 始 为 0) ， 而 另 一 台电 动机 产生 
直线 位 移 x,。 最 理想 的 是 x, = 罗 ， 但 在 实践 中 它们 可 能 会 有 所 不 同 ， 这 是 每 一 台 
电动 机 的 动态 性 能 不 同 造成 的 ， 并 且 由 于 沿 龙 门 滑 块 移动 而 出 现 动态 负载 。 龙 门 
台中 央 点 C 因此 被 限制 沿 着 两 自由 度 虚线 移动 。 从 原点 0 到 中 央 点 C 的 位 移 表 
MRA xo HFa Ax. 之 间 的 偏差 ， 龙门 还 可 能 垂直 于 图 4. 21 所 示 的 平面 ， 顺 着 
一 个 轴 旋 转 ， 这 个 转角 表示 为 9。 相对 于 龙门 的 滑 块 运动 表示 为 Y。 另 外 ， 假 定 
龙门 是 对 称 的 ， 从 C 到 滑 块 重心 S 的 距离 表示 为 4 =w +v。 











图 4.21 三 自由 度 结 构 


有 了 龙门 台 系统 的 表述 ， 接 下 来 要 进行 龙门 台 的 动态 建 模 。 由 m, A m, 分 别 
表示 该 龙门 和 滑 块 的 质量 。/ 为 龙门 手 辟 的 长 度 ，1,、 了 分 别 表 示 龙 门 手臂 和 请 


块 转动 惯量 /惯性 逢 (假设 =m(172)*, h=m,(5 +7), 且 X=[x07]", 其 





Hae aa, + 了 了 (参见 图 4.21)。 


m;, t=1, 2 的 位 置 如 下 


Xml EX (4.1) 

Ym =O (4.2) 

Xm =x + dcosð — ysind (4.3) 
ym = ycos@ + dsing (4.4) 


导致 的 相应 速度 为 


从 而 导出 om = fé] (4.5) 
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a —d0sing - ysing 一 ygcosb 
vma = . ， (4.6) 
ycos@ -ybsing + d@cos@ 


ANG, SMEAR 


K = Lmv T Dm + ma aY na +50, +1) 


= 元 (mi +m,) x? +40, +1,+m,y +m d) 


+ Imj? -x bm, [dsing + ycos@] - %ym,sin + Gym2d (4.7) 
可 进一步 写成 
K= JD xX (4.8) 
其 中 , D 是 下 面 公式 给 出 的 惯性 矩阵 
m, +m, 一 madsing -m,ycos@ -m,sing 
D=| —m,dsin@ -m,ycos6 1, +1, +my +md’ m,d (4.9) 
—m,sing md m, 
下 一 步 ， 科 里 奥 利 斯 (Coriolis) 和 离心 力矩 阵 C 的 元 素 可 以 得 出 如 下 
3 
= > (cigk) > (4. 10) 
fat 


FP, di, do 和 gs 分 别 代表 *，6 Aly 的 导数 ， 克 里 斯 托 费 尔 (Christoffel) 符 
号 Cy, 计算 如 下 





ôd; s(q) ao g 
-a ] 


Cy = (4.11) 


其 中 ，d 必 代表 了 惯量 矩阵 也 ami i 生生 alte. 代入 公式 假定 惯性 方程 
(4.9) nA L 并 计算 公式 (4.11)， 和 矩阵 C 可 以 表示 为 


0 Co, - bcosb 
l <. 
C=m, Co Co (7+2) ~ xcos@ (4.12) 
-gcosb (> +2y)6 — xcos@ 0 


其 中 
Cu =ygsing - dbcosb ~ ycosb 
Co = (ysing ~ dcosg)x% — (> +2y)% 
最 后 ， 动 态 模型 表示 为 
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DX+CX+BF=BU (4. 13) 
其 中 
1 1 0 
= 区 —leos@ o (4.14) 
0 0 1 
F=[F,,F2,F,]" (4.15) 
U=[u,,,ug,u,]" (4. 16) 


由 于 Fa, Fo, F, PRA, uy, uy, U, 是 沿 x1，x, My 分 别 产生 的 机 械 力 。 
摩擦 力 F 假设 用 塔 斯 廷 模型 充分 描述 ， 

F.=d,z +f.sgn(z) (4.17) 
其 中 , z 代表 x ，x%, Kyo 


4.4.2 基于 模型 的 自 适应 控制 设计 


对 于 实际 的 真实 系统 来 说 ， 准 确 获 取 模 型 mm ，m,，d; 和 fi(i=xi ,x,,y) 的 精 
确 值 是 一 个 具有 挑战 性 和 艰巨 的 任务 。 为 此 ， 构 造 了 基于 动态 模型 设计 的 自 适 应 
控制 器 。 

ME MYRRIRE s=Ae+e, Hrpe=X,-X, X 代表 所 需 的 轨迹 ， 可 以 二 次 微 
分 ; A 是 用 户 定义 的 参数 。 因 此 ， 公 式 (4.13) 可 以 表示 为 


Ds =D(Ae+X,) +CX+BF-BU (4. 18) 
参数 D,，C 和 下 可 进一步 表示 为 
D=m,D,+m,D, (4.19) 
C=m,C, (4. 20) 
F = > (4:Fo + fF) (4. 21) 
其 中 ， 各 种 系数 (Di, DiE) 如 方程 (4.22) ~ 方程 (4. 30) 所 示 。 
1 0 0 
no (1/2)? ° (4. 22) 
0 0 0 
1 - dsin@ ~ ycosb - sinf 
D, =| -dsing - ycosð (> +y) +y +a d (4. 23) 


— sing d 1 
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0 Co - ĝcosð 
G= Co Co ( + + 2y) 0 - xcosO 
- ĝcosð (> 2y) 0 - žcosð 0 


Fo =[%,,0,0]* 
Fy =[0,«,,0]* 
Fo = [0,0 yl" 
F,, =[sgn(x,) ,0,0]" 
Fy, = [0,sgn( x,) ,0] 
Fo =(0,0,sgn(y) ]" 
令 V=4b=m V, 


因此 ，W 可 以 表示 为 


0 Vo -bcosb 
_1 l . . 
nm = 下 Ym (zt 0 |, 
— ĝcosð 0 0 
和 Vo = d6cos6 - ycosé + yOsing 


现在 ， 滤 波 误差 方程 (4. 18) 可 以 重新 写 为 
Di = —Vs+m,D)(Aé+X,) +m [Vos + D,(Ae +X,) + Cx] 

+ > (dBFo + f,BF,,) - Bu 

建议 的 自 适应 控制 器 给 出 如 下 
U = B'Ks + m,B'D,(Ae + X,) 
+ m,B"[ Vos + D,(Ae+X,) +C, X] + > (d,Fo, + fF y;) 
随 着 适应 规则 如 下 
ta, =yis"D (A è +X,) 
ñ, = 28" Vos +D (Aè +X,)+0,X] 
À, = yas" BF y 


i= ys BF; 


Sy 


(4. 


(4. 
(4. 
(4. 
(4. 
(4. 
(4. 


(4. 


(4. 


(4. 


(4. 


(4. 
(4. 
(4. 


(4. 


24) 


25) 
26) 
27) 
28) 
29) - 
30) 


31) 


32) 


33) 


34) 


35) 
36) 
37) 
38) 
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其 中 , 天 >0 BEER, m,, m, d, 下 分别 为 m; ，m,，d;， 估计 数值 。 
4.4.3 稳定 性 分 析 


定义 以 下 Lyapunov 函数 
lo. 1. /1~, 17 
v = s'Ds +—m? +— m, + >d? + >f? (4.39) 
Yı | Y2 ? 2 (x ‘ yt) 


EH, ñi, ña, d, FAH m, m, di, /估计 误差 。 微 分 v 和 替代 方程 
(4.33), 方程 (4.34) 的 控制 律 为 


b = —2s"Ks +2 ,s"D,(Aé +X,) +2" [Vs +D (Aè +X) +C X] 


3 ~ ~ . . 
+2Ds (dBFo + f,BF,;) -24 8h, -24i 
izl Yı Y2 


3 
l~i 1 ~ 、 
-29 (zzid, + SS) (4. 40) 


结合 方程 (4.35) ~ 方程 (4. 38) 的 自 适应 律 ，5 变 成 
b = —2s'Ks (4.41) 
RUB s, M, Mm, d, 三 有 界 。 根 据 定义 的 滤波 误差 方程 ， 既 然 4 是 正定 和 
s EERW, EFK, e 也 是 有 界 的 。 这 也 意味 着 :是 有 界 的 ， 反 过 来 说 ，X， X 
是 有 界 的 。 此 外 ， 从 公式 (4.33) 可 以 得 出 结论 : ;是 有 界 的 , 方程 (4.41)， 
连同 " 的 定义 ， 共 同 暗 示 了 
limRs = V(0) -limV( æ ) (4. 42) 
最 后 ， 应 用 巴尔 巴 拉 特 (Barbalat) 31%, lims(t) =0。 


4.4.4 软件 仿真 


为 了 验证 本 方法 的 有 效 性 ， 三 个 轴 各 自 使 用 分 离 PID 控制 器 的 结果 来 比较 应 
用 龙门 动态 控制 器 模型 软件 版 本 开发 的 自 适应 控制 器 。 每 种 情况 都 建立 了 MAT- 
LAB 模拟 研究 。 龙 门 的 参数 选择 如 下 : 

HE m =1kg, m, = 1kg， 长 度 1 =0.415 m, FER d =0.015m， 摩 擦 参数 是 
di =d, =d, =1, MA =f = =1， 预 期 轨迹 《位 置 、 速 度 和 加 速度 ) 如 图 4. 22 
所 示 。 轨 迹 将 跨越 0. 01m 的 距离 ， 定 期 每 隔 4s， 达 到 最 高 速度 和 加 速度 分 别 是 
0.094m/s 和 0. 145m/s”, 

对 于 PID 控制 器 ,使 用 了 下 面 的 PID 控制 法 


u = Kye + K,fe + K, & (4.43) 
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时 间 /s 


图 4. 22 ”预期 轨迹 〈 位 置 、 速 度 和 加 速度 ) 


使 用 独立 的 轴 控 制 ， 每 轴承 担 相同 的 动力 ; 在 此 仿真 中 ， 所 有 三 个 PID 控制 回调 整 为 
K, =400, K, =50, K, =30, 
自 适应 控制 器 参数 配置 为 
y, =45 000 
Yı =2 800, ys, =4 000, yx =4 000, Ys, =28 000, Ya =Y4 =Y4s = 100, 
K =diag( 100 10 10), A 等 同 于 单位 矩阵 ， 即 A= diag(111)。 分 别 对 1、xs Aly 
轴 的 跟踪 误差 进行 模拟 仿真 的 结果 如 图 4. 23 所 示 ， 轴 间 偏 移 误差 如 图 4. 24 所 









































E 
= 
W 
z Adaptive control 
2 : ; OO 
0-025 5 10 15 20 25 30 35 40 45 5 


时 间 /s 
图 4. 23 分 别 对 x,、x, 和 y 轴 的 跟踪 误差 进行 模拟 仿真 的 结果 
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示 。 来 自 于 控制 器 的 模拟 控制 信号 如 图 4. 25 所 示 。 从 PID 为 基础 的 模拟 仿真 收 
集 的 数据 用 虚线 表示 ， 而 基于 适应 性 的 模拟 仿真 用 实 线 表 示 。 
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时 间 /s 
图 4.24 使 用 PID 控制 和 自 适 应 控制 的 x, Al x, 之 间 的 模拟 轴 间 偏 移 误差 


a) PID 控制 b) 自 适 应 控制 





控制 信号 x 


控制 信号 x 

















| PID 控制 

i 自 适 应 控制 
25 30 35 40 45 50 

时 间 /s 


图 4.25 分 别 对 x,、x, My 的 模拟 控制 信号 


对 于 一 个 短 的 从 :=0 到 :=3 的 延续 时 间 ，PID 控制 器 性 能 优 于 自 适 应 控制 
器 。 被 认为 是 预期 的 学 习 参 数 已 经 初始 化 为 无 先 验 知识 的 零 值 。 随 后 ， 在 自 适应 
某 些 参数 之 后 ， 该 方法 很 快 就 体现 出 比 PID 控制 在 性 能 上 有 显著 的 改进 。 可 以 进 
一 步 观察 到 在 实现 稳定 状态 之 前 ， 对 x, ，x: My 的 跟踪 误差 比较 合理 。 
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4.4.5 实施 结果 
试验 中 使 用 的 平台 是 图 4. 2 所 示 的 龙门 台 。 其 电动 机 的 规格 如 表 4. 2 所 示 。 
表 4.2 龙门 式 电动 机 规格 


























参数 蕊 轴 伺 服 电动 机 Y 轴 伺服 电动 机 
型 号 SEM MT22G2-10 Yaskawa SGML-01 AF12 
功率 350W 100W 
转 矩 0.70N -m 0. 318N -m 
转速 5000r/ min 3000r/ min 
误差 10pnm 10um 


为 了 实现 PID H, PAS X RH (X A X) 的 PID 控制 器 整定 为 K, =90, 
K,=5 AK, =1， 而 了 轴 被 整定 为 天 =30, K,=1 Al K,=0, WE 4.2 PHH, X 
轴 电 动机 与 了 轴 电 动机 不 同 ， 因 此 马 轴 和 了 工 轴 需 要 进行 不 同 的 整定 。 自 适应 控 
制 器 参数 配置 为 y; =Y = Ya = Ys = Vas = Ya = Yan = Yas =1.8, 天 =diag(4035) 
BA=diag(1 11), 

轨迹 类 似 软件 仿真 的 使 用 和 结果 如 图 4. 26 、 图 4. 27 和 图 4. 28 所 示 。 这 些 数 
字 都 呈现 类 似 的 特点 ， 与 从 软件 模拟 出 的 特点 一 致 。 对 比 x A x, 轴 的 0. 96mm 
PID 性 能 ， 自 适应 控制 器 在 稳 态 下 能 够 产生 低 于 0. 38mm 的 单 轴 误 差 ， 而 两 个 控 
制 器 的 工 轴 误 差 被 控制 在 2mm 以 下 〈 参 见 图 4.26) 。 此 外 ， 自 适应 控制 器 能 够 
减少 轴 间 偏 移 误差 〈 利 用 操纵 参数 天 ) MAR PID 控制 器 只 能 够 个 别 追 踪 独 立 


xio? 
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a [== PID 控制 | 
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图 4.26 x, x 和 yy 各自 的 跟踪 误差 
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的 轨迹 。 这 个 性 能 体现 在 : 一 个 是 采用 自 适应 控制 器 的 轴 间 偏 移 误差 0. 32mm, 
一 个 是 解 看 PID 控制 器 的 0.81mm (参见 图 4.27) 。 
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PID 控制 
一 一 自 适 应 控制 











图 4.27 使 用 自 适应 控制 和 PID 控制 的 xx 和 x, 的 轴 间 偏 移 误差 
a) 自 适应 控制 b) PID 控制 








时 间 /s 


BSH 几何 误差 补偿 


在 自动 定位 机 械 ， 如 坐标 测量 仪 (CMM) 和 机 床 中 ， 机 床 末端 执行 器 和 工 
件 两 者 的 相对 位 置 误差 直接 影响 最 终 产 品 或 设计 的 质量 。 定 位 不 准确 的 误差 有 各 
自 的 来 源 ， 有 静态 / 淮 静 态 误差 源 ， 如 结构 元 的 几何 误差 、 模 具 和 夹具 误差 、 感 
应 热 和 负载 引起 的 误差 ; 也 有 机 械 运动 的 动力 学 误差 。 这 些 误 差 一 般 分 为 以 下 两 
大 类 ; 

1) 完全 可 复制 和 重 现 性 好 的 系统 误差 。 

2) 明显 根据 系统 条 件 的 变化 而 变化 的 随机 误差 。 

虽然 彻底 消除 机 械 误差 在 物理 上 无 法 实现 ， 但 是 足够 好 的 机 械 设 计 和 足够 多 
的 投资 在 一 定 程度 上 可 以 减少 误差 ， 以 适应 特殊 机 械 的 应 用 要 求 。 普 遍 估计 得 
出 ， 随 着 精度 要 求 的 增加 ， 相 应 增加 的 成 本 要 高 得 多 。 因 此 ， 不 能 仅仅 是 依靠 机 
械 精 密 设 计 和 昂贵 的 工艺 ， 而 是 为 实现 性 能 指标 要 求 ， 选 择 另 一 种 形式 和 方法 在 
机 械 控制 中 适当 补偿 误差 ， 以 实现 相对 精度 的 提高 并 降低 更 多 的 成 本 。 有 三 坐标 
测量 仪 制 造 商 报告 说 ， 由 几何 误差 补偿 软件 技术 减少 的 生产 成 本 估计 为 
5%~50% 。 虽 然 机 床 广泛 采用 误差 补偿 仍 有 待 发 展 ， 但 误差 补偿 在 三 坐标 测量 
仪 的 应 用 是 巨大 的 ， 当 今 很 难 找 到 一 个 三 坐标 测量 仪 生产 商 不 使 用 这 种 或 那 种 形 
式 进 行 误差 补偿 。 

机 械 的 误差 补偿 并 不 新 鲜 。 伊 文思 (Evans) 早 在 1989 年 就 完整 介绍 了 误差 
补偿 的 进展 。 早 期 的 补偿 方法 主要 利用 校正 丝 杠 、 校 正 凸 轮 、 参 考 标尺 等 机 械 形 
A, Him, RA] (Maudslay) 和 顿 科 (Donking) 使 用 丝 杠 校正 ， 以 补偿 其 生 
产 机 械 的 尺 二 误差。 补偿 通过 机 械 进 行 了 校正 ， 但 是 不 可 避免 地 增加 了 物理 机 械 
的 复杂 性 。 此 外 ， 对 于 机 械 磨损 和 机 械 破裂 迅速 校正 不 再 有 效 。 校 正 部 件 必须 依 
赖 于 维护 或 者 定期 更 换 ， 所 有 这 些 提 高 了 机 械 的 停机 时 间 和 生产 成 本 。 

从 机 械 和 气动 子 系统 演变 到 以 微 处 理 器 为 基础 的 控制 系统 已 经 形成 了 新 的 和 
令 人 振奋 的 应 用 优势 。 控 制 系统 曾经 采用 许多 操作 复杂 的 连接 杠杆 、 凸 轮 和 保护 
线 ， 现 在 可 以 等 价 地 由 储存 在 电子 计算 机 内 存 中 程序 代码 来 更 为 有 效 地 替代 。 基 
于 软件 的 误差 补偿 方案 在 20 世纪 70 年 代 开 始 得 到 广泛 的 应 用 。 第 一 种 实现 方案 
是 摩尔 五 号 三 坐标 测量 仪 ， 它 的 开拓 工作 使 霍 肯 (Hocken) 在 1977 年 赢得 了 一 
枚 泰勒 (Taylor) 机 械 工程 研究 所 颁发 的 奖章 。 自 此 以 后 ,采用 软件 开发 和 实现 
的 机 械 误差 补偿 的 新 方法 一 直 不 断 地 发 展 。 

本 章 介 绍 几 何 误 差 的 补偿 原理 和 方法 以 及 相关 内 容 。 
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5.1 激光 测量 系统 概述 


激光 测量 系统 提供 给 机 床 制 造 商 和 用 户 机 床 精度 定位 必要 的 基本 的 测量 组 成 
部 件 ， 使 用 补偿 数据 校正 机 械 的 定位 误差 。 其 基本 系统 包括 一 个 激光 光源 、 补 偿 
电子 器 件 、 光 学 器 件 、 电 缆 及 配件 。 通 常 需要 一 台 计 算 机 控制 系统 和 光学 部 件 满 
足 机 械 几何 性 能 的 具体 测量 要 求 。 为 了 校准 ， 整 个 系统 应 能 够 收集 和 分 析 不 同 的 
测量 数据 ， 包 括 线性 误差 、 角 度 误 差 、 直 线 度 误差 和 垂直 度 误差 。 一 个 线性 激光 
的 测量 分 辩 率 可 高 达 lnm。 这 是 测量 过 程 可 以 实现 的 高 精度 ， 它 使 用 了 以 精确 激 
光波 长 为 基础 的 距离 测量 计算 ， 从 而 相 比 其 他 的 测量 系统 具有 更 高 的 精度 。 两 频 
率 激光 技术 还 经 常用 来 消除 光束 强度 变化 所 造成 的 种 种 问题 ， 从 而 得 到 更 好 的 和 鲁 
棒 性 和 可 靠 性 。 激 光束 基本 上 治 着 干涉 仪 和 相关 反射 镜 之 间 做 相对 运动 ， 所 以 大 
多 数 激光 测量 系统 进行 的 测量 是 一 种 线性 测量 。 大 多 数 情况 下 ,干涉 测量 仪 是 固 
定 的 光纤 ， 角 锥 棱镜 是 移动 部 件 。 其 他 测量 如 角度 、 直 线 度 和 垂直 度 测 量 ， 是 基 
本 线性 测量 实现 的 特殊 应 用 。 在 许多 激光 测量 系统 中 ， 误 差 补偿 表 在 激光 测量 和 
控制 输入 获得 后 可 以 自动 生成 。 这 些 表 可 用 于 伺服 系统 。 

本 章 将 主要 介绍 激光 HP5529A 测量 系统 。 激 光头 采用 了 氮 氛 激光 器 ， 具 有 
6mm (0. 24in) 光束 直径 ， 精 确 到 + 0.1 x10“ 的 632. 491354nm 真空 波长 。 激 
光头 使 用 了 长 寿命 的 激光 管 ，HP5529A 由 各 种 光学 和 配置 电子 系统 组 成 激光 校 
准 系统 ， 可 满足 许多 应 用 独特 的 物理 布局 和 测量 要 求 ， 并 成 为 机 械 校 准 和 补偿 目 
的 的 理想 选择 。 


5.2 激光 测量 系统 的 组 件 


激光 测量 系统 通常 包括 : 

1) 激光 头 。 

2) 干涉 仪 及 其 相关 反射 镜 。 

3) 测量 接收 器 和 测量 与 控制 电路 。 

某 些 测量 不 能 直接 将 干涉 仪 输入 光圈 对 准 激光 头 。 因 此 ， 这 类 系统 还 将 包括 
各 种 光束 定向 光学 部 件 。 此 外 ， 系 统 还 可 能 包括 环境 遥感 和 /或 波长 跟踪 ， 来 进 
一 步 测量 补偿 由 于 环境 参数 变化 随 之 而 来 的 激光 波长 的 变化 。 激 光 器 的 激光 头 用 
做 光束 和 参考 频率 源 。 光 学 仪器 和 测量 接收 机 使 用 激光 束 产 生 的 测量 信和 号。 参考 
和 测量 信号 与 环境 传感器 信号 一 起 测量 电路 产生 的 线 位 移 信 息 。 系 统 控制 器 可 以 
读 取 和 显示 此 位 移 信 息 。 此 外 ， 测 量 电路 输出 实时 信号 表示 一 个 目标 和 实际 位 置 
之 间 的 差 。 此 误差 信号 可 使 伺服 电子 系统 直接 驱动 伺服 电动 机 。 激 光 测 量 系统 示 
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意图 如 图 5. 1 所 示 。 















二 频率 氮气 激光 器 2 


线性 干涉 仪 回 射 镜 


参考 信号 
图 5.1 激光 测量 系统 示意 图 


5.2.1 激光 头 


激光 头发 射 的 激光 波长 是 激光 测量 系统 的 长 度 标准 。 激 光头 产生 相干 光束 由 
两 个 略微 不 同 的 频率 fi MA 的 正 交 极 化 高 频 成 分 组 成 。 光 束 在 激光 头 集合 出 现 
之 前 穿 过 一 个 分 束 器 ， 部 分 光束 被 采样 。 这 个 部 分 的 光束 用 于 生成 基准 频率 
(由 参考 接收 器 接收 ) ， 并 为 激光 腔调 谐 系 统 提供 一 个 误差 信和 号。 和 幅 值 的 
ZATRE, MA 和 所 频率 的 差 被 用 作 参 考 频率 ， 作 为 计算 线性 位 移 的 基础 。 
激光 头 的 原理 图 如 图 5.2 所 示 。 





图 5.2 激光 头 的 原理 图 


5.2.2 干涉 仪 和 反射 器 


干涉 仪 和 反射 器 是 激光 测量 系统 关键 的 光学 元 件 。 激 光头 发 出 光束 的 主要 部 
分 被 传送 到 干涉 仪 。 干 涉 仪 是 一 个 两 极 化 分 束 器 ， 反 射 一 个 极 化 光束 ， 传 送 另 一 
个 光束 。 光 束 分 路 器 定向 使 得 反射 光束 与 通过 的 光束 彼此 成 直角 。 光 束 i) 通 


第 5 章 几何 误差 补偿 * 101- 


常 从 安装 在 干涉 仪 上 的 一 个 固定 反射 镜 中 反射 。 传 输 频率 (fi ) 的 光束 通过 干涉 
仪 并 被 一 个 可 移动 的 反射 镜 反射 回去 。 如 果 干 涉 仪 和 可 移动 反射 镜 的 距离 保持 固 
定 在 一 个 确定 长 度 (相当 于 零 位 置 ) ， 频 率 的 偏差 ( 户 -f) 对 参考 信号 将 是 一 
样 的 。 根 据 这 些 条 件 ， 于 涉 仪 和 可 移动 的 反射 镜 系 统 检测 将 没有 相对 的 位 置 变 
化 。 当 移动 反射 镜 相对 固定 干涉 仪 的 位 置 发 生变 化 时 ， 多 普 勒 频率 转变 发 生 。 这 
个 多 普 勒 移 频 记 为 有 + Afi ， 根 据 反射 运动 方向 而 定 。 这 两 个 频率 成 分 有 +Afi 和 
厂 ， 作 为 同步 干涉 光束 发 出 。 干 涉 仪 和 反射 器 示意 图 如 图 5.3 所 示 。 





线性 干涉 仪 反射 镜 
线性 干涉 仪 一 固定 
反射 镜 一 移动 


图 5.3 干涉 仪 和 反射 器 示意 图 


5.2.3 测量 接收 机 


两 个 频率 的 正 交 极 化 激光 从 干涉 仪 发 出 并 输入 测量 接收 机 ， 然 后 经 过 探测 器 
的 接收 器 电路 进行 放大 和 处 理 ， 产 生 测量 频率 。 位 移 信息 随后 由 测量 电子 电路 通 
过 测量 和 参考 信号 的 比较 产生 。 该 接收 器 的 测量 原理 图 如 图 5. 4 所 示 。 





I&R 






激光 定位 电路 


5.4 接收 器 的 测量 原理 图 
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5.2.4 测量 与 控制 电子 电路 


从 参考 和 测量 接收 器 产生 的 均衡 信号 通过 测量 和 控制 卡 获得 。 卡 的 一 个 功能 
就 是 通过 读 取 和 适当 调节 共 模 信号 来 减少 外 部 噪声 。 另 外 ， 可 进行 信号 插值 来 提 
高 分 辩 率 。 测 量 和 控制 卡 一 般 包 括 波长 补偿 功能 。 激 光 测 量 系 统 的 精度 受到 相关 
环境 参数 变化 的 影响 ， 如 环境 温度 、 压 力 和 相对 湿度 变化 。 因 为 激光 的 波长 是 测 
量 长 度 的 标准 ， 对 这 些 特征 参数 敏感 。 波 长 偏差 可 以 根据 各 种 环境 传感器 的 测量 
估算 ， 然 后 得 到 手动 或 自动 的 补偿 。 


5.3 激光 校准 概述 


多 轴 机 床 的 准确 性 和 精确 度 主 要 取决 于 机 械 的 几何 属性 。 因 此 ， 要 充分 分 析 
机 械 的 定位 精度 必须 衡量 以 下 几何 特征 (每 一 项 都 对 机 械 作 业 区 任何 点 的 定位 
和 精度 有 作用 ) ; 

1) 每 个 测量 轴 的 6 个 自由 度 。 

2) 测量 轴 之 间 的 垂直 。 

3) 测量 轴 之 间 的 平行 。 

每 一 个 运动 轴 的 6 个 自由 度 如 图 5.5 所 示 。 





图 5.5 每 一 个 运动 轴 的 6 个 自由 度 


两 个 或 两 个 以 上 轴 间 运动 的 垂直 和 平行 表示 了 轴 相 对 的 方位 特征 。 垂 直 
和 平行 的 这 两 种 测量 可 利用 两 个 直线 度 测 量 完成 ， 垂 直 测 量 方法 需要 更 多 的 
光学 仪器 ， 如 90° 光 直角 规 。 这 些 几 何 特征 大 多 可 以 用 激光 测量 系统 适当 
获得 。 
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5.3.1 线性 测量 


线性 测量 是 指控 制 移动 部 件 直线 运动 时 对 其 平移 实际 距离 的 测量 。 需 要 在 移 
动 部 件 上 安装 反射 镜 进行 这 种 测量 。 在 伺服 控制 系统 中 ， 位 置 测 量 推断 通常 直接 
从 电动 机 的 编码 器 (或 相同 的 位 置 测量 装置 ) 获得 。 然 而 ， 由 于 编码 器 固有 的 
校准 误差 ， 在 编码 器 测量 与 实际 位 置 之 间 将 不 可 避免 地 存在 一 些 不 匹配 的 情况 。 
依靠 为 最 终 用 户 提供 电动 机 人 性 能 的 线性 评估 ， 激 光 系 统 将 能 够 解决 这 个 问题 。 获 
得 线性 测量 所 需 的 光学 系统 在 图 A.1 ( 附录) 中 给 出 。 典 型 的 线性 测量 装置 如 
图 5.6 所 示 。 


1 一 HP5519 激 光头 
2 一 HPLO7SGAS BER 1 E 4 ; , 7 
BE 








* 
5 E LOBERA TETEN E EOS 7 
6 一 HP10751D 空 气 传 选 件 ) 
7 一 HP10767A 线 性 Basi | 
8 一 HP10757D 材 料 温度 传 感 回 (计件 ) vat 
9 一 HP10753B 三 脚 架 i 
+ 一 连接 部 件 到 计算 机 的 电缆 连接 器 a bs 


一 ~ 
~ - y 
"a £ 
~ 
"X ~ 
=A. 
~ 


图 5.6 典型 的 线性 测量 装置 


5.3.2 角度 测量 


角度 测量 是 关于 由 理想 位 置 移动 部 件 〈 安装 有 角 反射 器 ) 的 角 位 移 (倾斜 ) 
测量 。 这 个 角 位 移 可 能 会 随 该 运动 部 件 线性 运行 的 距离 而 改变 。 产 生 角 偏差 的 主 
要 原因 包括 : 物体 引导 不 完善 和 可 能 的 齿 定位 相关 效应 。 角 度 测量 使 用 的 光学 元 
件 和 附件 比较 类 似 于 线性 测量 所 使 用 的 部 件 。 这 些 数字 设备 和 配件 如 图 A.2 所 
示 。 俯 仰 和 偏 航 测量 的 设置 分 别 如 图 A. 3 和 图 A. 4 所 示 。 图 5.7 所 示 为 激光 束 
横 深 路径 的 一 个 全 貌 图 ， 图 5. 7 说 明 角度 测量 是 由 两 个 已 知 精确 分 离 的 线性 测量 
组 成 的 。 滚 动 测量 将 在 下 一 节 中 分 别处 理 ， 因 为 这 种 测量 通常 需要 使 用 一 个 水 平 
敏感 设备 。 
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角度 干涉 仪 角度 反射 镜 


Hkh, 


Berroa 


_$_{_{_ _—— 
af 5 fa REC 
激光 器 读数 
32.6mm 


图 5.7 激光 束 横 深 路 径 的 一 个 全 貌 图 








0=arcsin 


5.3.3 直线 度 测量 


直线 度 测量 的 目的 是 确定 部 件 是 否 沿 着 一 条 直线 路 径 移 动 。 直 线 度 误差 的 主 
要 来 源 是 引导 移动 部 件 运动 机 构 的 直线 度 外 形 。 直 线 度 测量 所 需 的 光学 部 件 如 图 
AS 所 示 。 外 形 直线 度 可 以 分 为 两 部 分 : 横向 和 纵向 直线 度 。 进 行 这 些 测量 设置 
的 原理 图 如 图 A. 6 所 示 。 图 5. 8 所 示 为 干涉 仪 内 运行 的 两 个 光路 。 镜 轴 作 为 光学 
直 边 ， 为 直线 度 测 量 提供 了 参考 。 






镜面 (直线 度 反 射 镜 ) 
补偿 的 沃 拉 斯 顿 楼 镜 






AZAS LEAS, 


注 : Hn, Pe ii Ad 
1 的 折射 率 对 另 一 
平 ne 

横 w.1 具 有 相反 的 特性 


图 5.8 干涉 仪 内 运行 的 两 个 光路 


5.3.4 王 直 测量 
直线 度 和 垂直 度 的 测量 通常 是 同时 进行 的 ， 因 为 垂直 测量 分 成 相互 垂直 的 两 
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直线 测量 。 这 些 测量 使 用 户 可 
以 确定 两 个 机 轴 是 否 相 互 垂直 。 
铣床 有 一 个 水 平 主轴 和 垂直 于 
主轴 的 移动 床 ， 它 是 有 两 垂直 
轴 机 械 的 一 个 例子 。 一 个 垂直 
移动 的 探测 器 安装 在 一 个 水 平 
移动 桥 上 的 三 坐标 测量 仪 是 两 
垂直 轴 机 械 的 另 一 个 例子 。 产 
生 垂 直 度 偏差 的 一 个 主要 原因 
可 能 是 制造 或 装配 两 条 轴线 互 





相 垂直 的 机 械 时 制造 或 装配 受 。 ERASMAS 
` 3 ge Ato > E 
到 限制 。 垂 直 测量 将 是 有 益 的 ， -NANAS 


、 EN fe EERI O KENA 

mu man en 如 图 5.9 两 直线 度 测 量 获得 垂直 度 误差 的 原理 
图 A.7 所 示 。 水 平面 上 垂直 测 
量 的 主要 程序 是 要 沿 第 一 个 轴 ， 如 图 A. 8 所 示 ， 使 用 光 直 角 规 进行 测量 ， 随 后 
沿 第 二 个 轴 按 照 图 A 9 的 设置 进行 测量 。 沿 着 较 早 前 安装 有 反射 镜 的 第 一 次 测 
量 轴 ， 第 二 个 轴 的 测量 是 简单 的 水 平 直线 度 测 量 。 图 5. 9 所 示 为 两 直线 度 测量 获 
得 垂直 度 误差 的 原理 。 

垂直 平面 上 ， 垂 直 测 量 的 执行 过 程 与 水 平面 类 似 ， 除 了 在 光学 方面 额外 的 要 
求 以 外 ， 所 需 的 设备 设置 如 图 A. 10 所 示 。 沿 纵 轴 ( 即 z 轴 ) 的 测量 设置 如 图 
A. 11 所 示 。 


5.4 使 用 水 平 敏感 设备 的 滚动 测量 


滚动 测量 指 的 是 自身 轴 旋 转 的 测量 。 即 使 有 全 套 设 备 的 激光 干涉 仪 ， 自 身 
轴线 翻滚 倾斜 的 测量 也 相当 麻烦 。 因 此 ， 通 常用 电子 水 平 测量 系统 来 帮助 进行 
这 一 特殊 的 测量 。 简 单 的 工作 原理 是 : 利用 电子 检测 系统 配备 的 钟 摆 来 精确 检 
测 有 关 参 考 钟 摆 的 姿态 。 该 设备 由 两 个 部 分 组 成 : 水 平 单元 和 显示 单元 。 水 平 
单元 要 固定 到 移动 的 部 件 ， 显 示 单 元 显示 角 的 偏差 。 准 确 度 0. 2 弧 秒 就 可 以 很 
容易 地 实现 商业 水 准 的 测量 系统 。 对 于 滚动 测量 ， 水 平 传感器 将 固定 于 移动 的 
部 件 上 。 当 轴 移 动 到 指定 的 位 置 时 ， 在 钟 摆 上 摆 杆 将 通过 显示 屏 反 映 角度 。 通 
常 由 PC 的 接口 提供 接收 送 到 PC 的 测量 值 。 图 5. 10 所 示 为 一 个 水 平 传感器 的 
工作 原理 框图 。 
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水 平 测量 单元 水 平一 一 零 倾斜 





KEATEN A ENS 
5.10 一 个 水 平 传感器 的 工作 原理 框图 


5.5 精度 评估 

机 床 或 坐标 测量 仪 (CMM) 校准 的 背后 主要 目标 是 决定 其 定位 精度 ， 也 就 
是 说 改进 机 床 工作 范围 内 的 定 了 典型 三 轴 的 误差 源 , 固 定 主轴 
位 精度 。 这 种 校准 无 法 直接 实 M 
现 ， 但 可 以 通过 测量 三 个 轴 中 
每 个 轴 的 6 个 自由 度 和 测量 三 


4K LIVER X, YAZA 
之 间 垂 直 度 来 实现 。 因 此 ， 有 
21 个 误差 源 需 要 校准 ， 典 型 
三 维 机 械 的 误差 源 如 图 5. 11 
所 示 。 误 差 校准 可 能 是 一 个 耗 
时 的 过 程 。 补 偿 前 后 准确 度 的 
评估 通常 是 通过 对 角 的 测量 工 
作 进 行 的 。 由 于 刀具 沿 着 物体 
工作 区 对 角 线 通过 ， 所 有 的 轴 
必须 准确 地 沿 对 角 线 位 置 一 致 图 5.11 典型 三 维 机 械 的 误差 源 
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运动 。 机 床 验 收 测试 或 在 定期 保养 程序 时 对 角 线 测量 是 有 用 的 ， 可 以 迅速 评估 这 
台 机 械 的 状况 。 因 此 ， 沿 工作 区 域 对 角 线 直线 测量 可 以 提供 一 个 整体 的 定位 精度 
快速 评估 。HP10768A 对 角 线 测量 工具 包 是 HP5529A 激光 测量 系统 的 一 个 光学 配 
件 ， 配 件 示 意图 如 图 A. 12 所 示 。 图 A. 13 所 示 为 一 个 对 角 线 测量 所 使 用 的 典型 
光学 系统 。 典 型 对 角 线 测量 的 设置 如 图 A. 14 所 示 。 


5.6 影响 测量 精度 的 因素 


激光 测量 相关 的 准确 性 通常 也 受到 有 关 设 置 、 光 学 变形 及 环境 条 件 几 个 因素 
的 影响 。 主 要 因素 介绍 如 下 。 


5.6.1 线性 测量 误差 


1. Abbé 误差 

一 台 机 械 测 量 轴 和 实际 位 移 轴 之 间 的 垂直 距离 (尺度) 称 为 Abbé 误差 。 运 
动 部 件 移 位 有 一 个 角 位 移 时 ， 产 生 了 Abbé RÆ E., WE, Abbé 偏 移 必然 存在 。 
Abbé 误差 如 图 5. 12 所 示 ， 当 移动 部 件 2 已 经 移动 了 一 个 测量 标注 为 5 的 距离 
时 ， 对 应 的 实际 距离 事实 上 是 标注 为 6 的 距离 。 





图 5.12 Abbé 误差 


Abbé 误差 按 角 和 Abbé 偏 移 两 者 大 小 的 比例 增加 。 因 此 ， 为 了 减少 这 种 误 
2, 测量 应 尽 可 能 地 接近 移动 部 件 ， 即 Abbé 偏差 应 尽 可 能 小 。 

2. 死 程 误差 

死 程 是 干涉 仪 和 反射 镜 (反射 镜 在 零 位 时 ) 之 间 的 测量 路 径 的 一 部 分 。 由 
于 是 理想 的 零 位 ， 多 普 勒 频 移 只 是 与 移 位 有 关 ; 否则 ， 由 于 死 程 的 出 现 ， 线 性 测 
量 可 能 包含 一 个 额外 的 部 分 。 当 空气 折射 指数 有 变化 时 ， 死 程 误 差 可 能 会 明显 地 
表现 为 零点 的 转移 ， 造 成 机 械 重 复 性 差 。 图 5. 13 所 示 为 死 程 误差 的 一 个 例子 。 
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为 了 减少 这 种 误差 ， 干 涉 仪 2 应 尽 可 能 放 在 接近 反射 镜 5 的 位 置 ， 而 又 不 能 让 它 


们 接触 。 


一 第 三 A 
反射 镜 





激 

SET BAL 

Bee me 1 2 3 4 5 6 
一 在 

aA 


RA a enemas 
9 一 干涉 仪 安装 位 置 尽量 


图 5. 13 死 程 误差 的 一 个 例子 


3. 余弦 误差 

余弦 误差 产生 时 ， 激 光 和 所 需 测 量 的 轴 不 是 直线 排列 ， 使 记录 的 测量 比 机 械 
的 实际 行程 更 短 。 误 差 随 运行 的 距离 和 偏差 增 大 。 图 5. 14 是 一 个 夸张 的 余弦 误 
差 的 例子 。 


5. 6. 2 


Stee 1 2 3 4 5 6 
3 一 反射 镜 在 第 一 次 测量 位 置 
一 沿 测量 轴 位 移 

及 射 镜 在 第 一 个 测量 位 和 


=% 

eB 
一 测量 轴线 
一 实 





图 5. 14 一 个 夸张 的 余弦 误差 的 例子 


角 测 量 误差 


角 测 量 精度 可 能 在 反射 镜 间 距离 微小 变化 时 受到 影响 。 为 了 将 两 个 线性 测量 
转换 成 一 个 角 的 测量 ， 需 要 精确 知道 反射 镜 之 间 的 距离 。 这 种 距离 变化 可 能 会 由 
于 角 反射 镜 壳 温 度 变 化 而 发 生变 化 。 为 了 减少 这 种 误差 ， 过 多 的 角 反 射 器 操作 和 
不 同 温度 介质 的 接触 应 当 避 免 或 者 减 到 最 小 。 


5.6.3 


直线 度 测 量 误差 


直线 度 测 量 精 度 在 很 大 程度 上 取决 于 两 个 直线 反射 平面 镜 是 否 具有 理想 的 表 
面 特性 。 如 果 平 面 镜 或 凸 或 目 ， 这 些 特 征 会 产生 一 个 直线 度 误差 ， 即 使 移动 部 件 
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是 沿 着 笔直 的 直线 移动 的 。 减 少 这 种 误差 的 一 个 方法 是 旋转 直线 度 反 射 镜 180°, 
获得 第 二 组 测量 。 至 少 有 两 个 测量 结果 集合 可 以 采集 ， 来 计算 实际 的 平均 偏差 。 
虽然 这 个 过 程 可 能 会 非常 耗 时 ， 这 是 弥补 直线 度 光 学 仪 平 面 差距 的 一 个 有 效 
方法 。 

直线 相关 的 误差 也 可 能 发 生 在 直线 度 反 射 参考 平分 线 不 是 用 激光 干涉 仪 对 齐 
的 ， 导 致 失调 (斜率 ) 被 错误 地 理解 为 直线 度 误差 ， 如 图 5. 15 所 示 。 

1 一 干涉 仪 

2 一 参考 平分 线 

3 一 机 器 行程 

4 一 实际 直线 外 距离 

5 一 直线 度 反射 鲁 
6 一 数据 路 径 





图 5.15 直线 度 测量 误差 


5.6.4 环境 条 件 


环境 条 件 ( 尤 其 是 温度 系数 ) 可 以 影响 激光 波长 的 参考 值 ， 因 此 影响 测量 
精度 。 环 境 的 温度 、 压 力 和 相对 湿度 都 属于 众多 一 般 因 素 中 应 尽 可 能 解决 的 环境 
因素 。 此 外 ， 环 境 参 数 的 变化 也 可 能 导致 在 校准 和 补偿 阶段 有 不 适当 的 几何 误差 
补偿 ， 不 同 的 环境 条 件 得 到 不 同 的 机 械 几 何 特性 。 虽 然 它 们 的 影响 在 机 器 上 可 能 
会 是 随机 的 ， 但 是 它们 可 以 在 一 定 程度 上 得 到 补偿 。 

CMM (坐标 测量 机 ) 和 机 床 的 热效应 可 以 使 机 械 的 结构 产生 非常 复杂 的 特 
性 。 它 们 有 不 同 的 来 源 ， 包 括 不 直接 与 机 械 相关 的 操作 ， 如 房间 温度 、 光 源 和 液 
压 系统 等 。 对 于 这 些 影响 ，Bryan 在 1990 年 的 论文 中 有 非常 全 面 的 描述 。 为 了 尽 
量 减少 热膨胀 效应 ， 就 必须 让 机 械 和 光学 仪 温度 稳定 ， 然 后 才能 测量 。 良 好 的 环 
境 温度 调节 可 能 是 必要 的 ， 这 取决 于 应 用 程序 和 要 求 。 虽 然 可 以 近似 补偿 ， 但 全 
部 由 电脑 热 补偿 是 非常 困难 的 。 一 阶 热 效应 建 模 与 补偿 更 现实 和 适合 实际 情况 。 
一 阶 热 校正 需要 每 轴 至 少 有 一 个 传感器 。 使 用 多 个 几何 误差 模型 来 反映 几何 学 中 
的 热效应 ， 每 一 个 模型 在 特定 的 工作 温度 范围 内 是 有 效 的 。 

测量 光学 仪 静止 时 ， 额 外 的 振动 和 空气 满 流 可 以 由 测量 结果 的 随机 漂移 来 确 
定 。 也 可 以 由 漂移 的 增加 或 连续 运行 使 光学 部 件 间 距离 的 增加 来 确定 它们 的 影 
响 。 防 止 影 响 的 方法 是 确保 所 有 设备 的 刚性 固定 和 支撑 ， 并 利用 足够 的 通风 设备 
让 空气 充分 流通 。 
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5.7 总 体 误 差 模 型 


常见 的 几何 误差 补偿 的 主要 工作 是 对 机 械 误 差 建 模 ， 模 型 隐 式 或 显 式 地 用 于 
补偿 器 。 机 械 模型 的 几何 设计 用 以 补偿 在 刚体 假设 下 机 械 几 何 误差 的 系统 部 分 。 
二 维 测量 机 如 图 5. 16 所 示 。 在 二 维 测量 机 模型 中 使 用 三 个 独立 的 坐标 系统 ， 分 
别 是 有 关 工 作 台 的 (0, X, Y), HH (01, X, Y) MX HRW (O,, X, 
Y,)。 假 设 初 始 条 件 满足 所 有 的 三 个 原点 和 三 个 系统 的 轴线 配合 校准 ， 因 此 ， 当 
桥 移动 了 一 个 单位 距离 了 时 ， 桥 的 原点 0, 的 实际 位 置 ， 对 于 工作 台 系 统 以 矢量 
给 出 。 





图 5.16 二 维 测量 机 


-| 6,(y) 
Ly +8,(y) 
同时 ， 由 于 角 的 误差 ， 桥 坐标 系统 相对 于 工作 台 系 统 旋 转 。 这 个 旋转 可 以 由 矩阵 
表示 


(5.1) 


1 €, 
R| 。 | (5.2) 
同样 ， 当 X 托 架 移动 了 一 个 单位 距离 x， 则 


0,0, -| | =| “] 


ô, (x) -ax E, 1 (5.3) 


0,P = a (5.4) 


AP, x, y WORE; x,, y, 表示 工具 尖 的 偏 移 量 ; 6,(v) 是 bv 方向 下 沿 着 
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方向 运动 的 平移 误差 e, 是 uw 轴 旋 转 ; a 表示 偏离 垂直 度 的 误差 。 
因此 ， 就 可 以 得 出 该 工作 台 系 统 的 体积 误差 模型 
OP = 00, +R- 10,0, +R-1R 1O,P (5.5) 
式 (5.1) ~ 式 (5.4) RAA (5.5), HEES, ee, ~0,€,5,(0) ~0,€,0~0, 
因此 e,，6,(v) ，a 非常 小 ， 几 何 误差 可 沿 着 x 和 yy 方向 分 别 补偿 
Ax =6.(x) +6,(y) -Y (€ +€,) +%, (5.6) 
Ay =6,(%) +8,(y) +xe, -xæ +x, (€, +€,) +Y, (5.7) 
应 该 指出 的 是 ， 以 上 误差 都 是 唯一 使 用 线性 位 移 测 量 的 适当 组 合 来 校准 误差 
源 的 。 


5.8 几何 误差 的 查 表 


几何 误差 的 补偿 通常 通过 查找 一 个 存储 表 的 形式 来 实现 。 查 表 是 基于 机 械 工 
作 空 间 中 收集 点 和 校准 点 而 建立 的 。 查 表 可 在 矩阵 中 获得 全 部 位 置 误差 ， 每 个 矩 
阵 的 元 素 分 配给 工作 区 的 一 个 校准 点 。 误 差 记录 之 间 的 点 使 用 线性 插值 ， 只 有 六 
个 相 邻 的 点 (三 维 数据 的 校准 ) 是 恢复 和 插值 的 。 

一 维 误差 补偿 表 如 图 5. 17 所 示 。 假 定 激光 测量 系统 根据 编码 器 反馈 在 同样 
距离 的 点 校准 一 个 轴 。 定 义 x ，x,，... ，%, 作 为 编码 器 的 测量 值 ，e, ，e,，...， 
e, 为 激光 测量 系统 所 获得 的 与 之 相应 的 定位 误差 。 对 于 x;_1 与 *,; 之 间 的 一 个 特定 
点 x*， 相 关 的 误差 e 可 通过 线性 插值 过 程 估计 为 

e= (s-a) te (5. 8) 

许多 伺服 运动 控制 器 允许 通过 查 表 进 行 几何 误差 补偿 。 例 如 ，Delta Tau 数 
据 系 统 公 司 的 可 编程 多 轴 控 制 器 (PMAC) 是 一 个 高 性 能 的 伺服 运动 控制 器 ， 
它 是 查 表 执行 补偿 功能 的 。PMAC 有 足够 的 容量 ， 可 以 存储 高 达 八 个 这 种 补 
偿 表 。 








图 5. 17 一 维 误差 补偿 表 


对 于 PMAC 的 二 维 补偿 ， 伺 服 电动 机 补偿 的 数值 将 取决 于 两 个 电动 机 的 位 
E, PMAC 补偿 表 如 图 5-18 所 示 。 每 个 电动 机 有 一 个 相关 的 查找 表 。 除 另 有 规 
定 外 ,来 自 电 动机 CRAE) 的 位 置信 息 用 于 提取 适当 的 表 中 修正 项 (目标 
数据 ) 。 因 此 ， 二 维 补偿 表 与 两 个 源 电 动机 和 一 个 目标 电动 机 有 关 。 这 种 补偿 
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是 由 内 部 伺服 回路 在 每 个 伺服 控制 循环 内 完成 的 。 通 常 在 补偿 表 中 ， 这 是 在 两 
个 选择 之 间 的 值 ， 所 以 PMAC 在 这 两 个 选择 值 之 间 线 性 插值 获取 当前 伺服 循环 
的 校正 。 


定义 补偿 20. 15， 机 ， 42,83, 20000. 15000 


toni 一 
表 行 

第 一 个 源 电 动机 
第 二 个 源 电 动机 


目标 电动 机 
第 一 电动 机 跨度 数 
第 二 电动 机 跨度 数 


图 5.18 PMAC 补偿 表 


在 操作 过 程 中 ， 为 两 个 源 电动 机 给 定位 置 补偿 ，PMAC 计算 围绕 该 位 置 的 四 
个 指定 补偿 加 权 平 均值 。 

查 表明 显 对 增加 精度 变 得 越 来 越 重要 ， 但 其 也 存在 一 些 缺 点 。 首 先 ， 查 表 有 
很 大 的 内 存 要 求 。 当 一 个 三 维 工作 空间 中 的 校正 数据 点 〈 因 子 N) 增加 时 ， 表 
项 的 数目 按 N 增加 。 因 此 ， 查 表 对 于 高 精密 机 械 就 特别 困难 了 ， 因 为 高 精密 机 
械 中 有 大 量具 有 重要 意义 的 必要 的 校准 工作 ， 用 以 补偿 误差 和 使 精确 阅 值 在 可 以 
接受 的 范围 内 。 其 次 ， 对 于 查 表 的 记录 数据 与 相关 中 间 点 的 误差 补偿 使 用 线性 插 
值 。 假 设 误差 在 校准 点 之 间 的 变化 是 线性 的 ， 并 且 邻 近 点 并 不 用 来 改善 插值 。 如 
果 校 准 基于 较 好 的 时 间 间 隔 ， 满 足 了 精度 要 求 ， 线 性 插值 就 足够 了 。 但 是 ， 这 反 
过 来 又 意味 着 巨大 的 内 存 需 求 可 能 将 超出 了 一 个 典型 查 表 的 能 力 。 第 三 ， 考 虑 影 
响 定位 精度 的 其 他 因素 ， 如 热 和 其 他 环境 影响 ， 没 有 一 个 结构 的 表 可 以 直接 扩 
张 。 当 考虑 这 些 更 精确 补偿 的 因素 时 ， 通 常 根 据 环境 参数 的 时 间 表 来 设置 附加 
表 。 最 后 ， 连 续 在 线 误 差 补偿 ， 通 过 查 表 每 个 采样 周期 都 需要 查找 ， 特 别 是 校准 
不 定期 发 生 时 ， 查 找 这 种 规模 巨大 的 表 确 实 令 人 头疼 。 


5.9 几何 误差 的 参数 化 模型 


由 于 组 成 误差 的 每 个 部 分 以 非 线性 位 移 的 方式 变化 ， 它 与 查 表 相 比 ， 更 自然 
倾向 于 利用 非 线性 函数 表示 非 线性 分 布 。 径 向 基 吨 数 (RBF) 是 一 般 的 非 线 性 函 
数 建 模 工具 ， 因 为 它 可 以 逼近 任意 非 线性 函数 ， 并 达到 任何 期 望 准确 性 的 水 平 。 
考虑 查 表 的 不 足 之 处 ， 使 用 RBF 可 获得 更 理想 的 功能 。 首 先 ， 适当 调整 RBF 可 
以 减少 大 量 的 数据 点 ， 更 易于 管理 RBF 参数 的 数目 。 其 次 ，RBF 对 中 间 点 基本 
上 使 用 非 线性 播 值 而 不 校准 ， 形 成 一 个 平滑 的 误差 建 模 。 第 三 ，RBF 可 以 在 增加 
校准 点 的 基础 上 调 校 ， 并 很 容易 扩展 ， 包 括 考虑 其 他 的 误差 补偿 因素 ， 如 热效应 
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Fo RA, RBF 是 一 个 参数 模型 。 输 出 直接 在 输入 基础 上 计算 ， 不 必 为 校正 搜索 
条 目 。 在 本 节 中 ， 将 介绍 用 RBF 模型 处 理 组 成 误差 的 每 个 环节 。 


5.9.1 径 向 基 范 数 与 误差 建 模 


为 估计 目的 使 用 RBF， 这 里 RBF 的 主要 性 质 是 函数 的 逼近 性 质 。RBF 网 络 
是 一 种 前 馈 网 络 。 它 们 形成 了 从 输入 矢量 x 到 输出 矢量 Y 的 一 个 映射 。 

BS) 是 一 个 从 RR 到 及 光滑 函数 。 然 后 ， 给 出 一 个 紧 普 集 Se R 和 一 个 正 
数 ew， 存 在 一 个 RBF 网 络 ， 使 得 


f(x) = Dodi Ix all?) +e (5.9) 
RH, o; 为 代表 的 价值 矢量 并 且 6;(a) =exp( -a) UHAyvyeS EHF |e ll 
< En 的 径 向 基 函 数 。 
研究 表明 ， 在 一 般 的 假设 下 ，RBF BAN, BABEJ EERE 
逼近 任何 一 个 紧 集 上 的 连续 孙 数 。 因 此 ，RBF 将 用 于 通 近 与 各 误差 分 量 相 关 的 
非 线 性 函数 。 为 了 获取 o 权 ， 应 采纳 一 些 权重 调整 算法 。 一 个 常用 的 权重 调整 
算法 是 基于 反 向 传播 误差 的 梯度 搜索 算法 ， 该 方法 可 以 离线 训练 RBF， 匹 配 指 定 
的 典型 对 (yas Ya), HEP ya 作为 理想 的 RBF RA, Ya 为 RBF 产生 的 所 需 输 
出 。BP 算法 的 RBF 离散 时 间 形 式 为 
w,(t+1) =w,(t) -n,Eq9( || x-e ||?/o7) (5.10) 
c(t+1) =¢,(t) — 9 Ew, (yz -6:) 6; ( || xy -¢; |1?/e7) (5.11) 
EF, yn, n 是 正 的 设计 参数 ， 决 定 算法 的 收敛 速度 ; o 为 一 个 常数 。 反 向 传 
播 误 差 定义 为 理想 的 RBF 输出 减 去 实际 输出 ，E =Y, -Y。 终 止 条 件 通常 是 这 
个 制定 的 误差 项 将 结束 迭代 权重 调整 的 过 程 。 因 此 ， 可 获得 最 佳 的 加 权 值 
W* = [wi ,i=0,1,2,…,m| ， 它 通常 是 合适 的 量 与 迭代 时 间 的 权衡 结果 。 由 于 调 
整 过 程 离线 完成 ， 更 加 强调 较 长 时 间 调 整 以 得 到 更 合适 的 结果 。 


5.9.2 参数 误差 逼近 


进行 单个 几何 误差 分 量 的 建 模 并 由 此 得 到 基于 RBF 的 模型 ， 本 节 将 对 RBF 
的 应 用 进行 充分 的 说 明 。 为 了 采集 训练 RBF 的 误差 数据 集合 ， 这 里 使 用 了 惠普 
(HP) HP5529 激光 干涉 仪 。 

试验 装置 如 图 5. 19 所 示 ， 对 沿 工 和 了 两 轴 100mm 的 运行 试验 进行 Imm FF 
程 的 校准 工作 。 因 此 ， 对 每 轴 各 误差 组 成 部 分 收集 100 个 点 。 图 5. 20 所 示 为 由 5 
个 完整 的 双向 半 托 架 沿 XX 方向 运行 采集 到 的 线性 误差 。 按 5 个 周期 计算 平均 值 
以 尽量 减少 任何 随机 产生 的 影响 。 
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图 5.20 x 线性 误差 的 原始 数据 集 
1. 线性 误差 


线性 误差 可 能 有 各 种 来 源 ， 包 括 沿 导轨 的 几何 缺陷 和 测量 偏 移 /误差 。 对 于 
所 研究 的 XY 工作 人 台 ， 最 大 的 误差 可 能 是 来 自 于 螺纹 运动 产生 的 非 线 性 和 反弹 的 
有 关 误 差 。 图 5.21 所 示 为 移动 托 架 上 的 螺纹 运动 的 结构 。 机 械 接触 的 空气 间隙 
可 能 导致 实际 的 位 移 发 生 较 大 变化 。 这 或 许 也 解释 了 正 向 和 反 向 线性 误差 测量 的 
差异 。 

对 于 线性 误差 建 模 ， 选 择 RBF 的 m = 80。 梯 度 权重 调整 算法 的 终止 条 件 是 
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图 5.21 螺纹 运动 的 结构 


emw<0. 01 ， 其 中 6, 为 均 方 误差 。RBF 函数 的 扩展 系数 o =2, 10° 次 参数 自学 习 
反复 迭代 后 ,根据 终止 条 件 该 算法 收敛 。 得 到 的 权重 提供 给 RBF 使 用 。 模 型 的 
线性 误差 可 表示 为 

5,(%) =fin,s (25 Wins) (5. 12) 
Rh, x 是 输入 沿 X 轴 的 标 称 距 离 ; fin (+ ) 代表 RBF 网 络 ; Wi 为 训练 后 的 
RBF 的 权重 值 。 图 5. 22 显示 了 RBF 网 络 的 输出 紧 随 线 性 误差 测量 。 同 样 ， 可 以 
得 出 

ô, (y) =fiiny (Y; Wainy) (5.13) 


> nD % 


XX 轴线 性 误差 的 RBF/um 
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位 置 /mm 
图 5.22 线性 误差 〈 工 轴 ) 的 RBF it ( 实 线 是 基于 RBF 的 和 逼近， 圆圈 代表 实测 数据 ) 


图 5. 23 所 示 为 RBF 网 络 输出 与 了 轴 的 线性 误差 测量 的 比较 。 
通常 情况 下 ， 运 动 方向 在 校准 过 程 中 没有 解决 。 机 械 正 向 和 反 向 运行 获取 的 
测量 平均 值 只 是 用 来 构造 补偿 器 ， 补 偿 器 可 以 是 查 表 或 在 这 种 情况 下 用 RBF 构 
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图 5. 23 ”线性 误差 (了 轴 ) 的 RBF 逼近 ( 实 线 是 基于 RBF EMT, ARE) 
建 。 对 于 一 台 具 有 更 为 严重 的 方向 不 对 称 几何 性 质 的 机 械 ， 可 以 为 每 个 相对 应 的 
运动 方向 的 误差 分 量 构建 两 个 RBF BU. AS. 24 所 示 为 一 个 非 对 称 线性 误差 的 

例子 。 
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图 5. 24 ”一 个 非 对 称 线性 误差 的 例子 (KREET RBF Bi, BRASS 
(向 前 运动 ) HERAT RBF BI, + 代表 实测 数据 〈 反 向 运行 ) 直线 ) 


2. 直线 度 误差 

直线 度 误差 主要 源 于 导轨 。 直 线 度 误 差 测量 是 与 一 条 参考 直线 的 垂直 偏差 得 
到 的 。 对 XY 工作 台 直 线 度 误 差 ， 有 两 个 组 成 部 分 是 可 以 确定 的 ， 即 与 沿 了 轴线 
偏差 有 关 的 X 轴 直线 度 ， 以 及 与 沿革 轴线 偏差 有 关 的 了 轴 直 线 度 。 

为 了 沿 轴线 对 直线 度 误差 建 模 ，RBF 的 规模 和 终止 条 件 可 以 使 用 线性 误差 
RBF 相同 的 规模 和 条 件 。 经 过 总 数 约 10° RUEBEN, NEEE EA IE 
APU, HEF RBF 相应 的 直线 度 模型 分 别 为 

5, (x) =Sara (x; Wir) (5.14) 
6.(7) =fary (Y3 Way) (5.15) 
基于 RBF 直线 度 误差 逼近 模型 的 优点 分 别 如 图 5. 25 和 图 5. 26 所 示 。 
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图 5.25 直线 度 误差 (XH) 的 RBF RE (KREET RBF BU, GRRE) 
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图 5.26 直线 度 误差 (YAH) 的 RBF 逼近 ( 实 线 是 基于 RBF 逼近 ， 圆 圈 代 表 实 测 数据 ) 


3. FIRE 

非 均匀 性 和 变形 的 导轨 也 会 产生 角 误 差 。 根 据 式 (5.6) 和 式 (5.7), RA 
偏 航 误差 (YW) 需要 测量 ,通过 XY 工作 台 的 零点 补偿 功能 。 俯 仰 和 横 滚 误差 
是 不 相关 的 ， 因 为 这 里 XY 工作 台 是 一 种 二 维 运动 系统 。 偏 航 误 差 测 量 是 沿 了 轴 
移动 路 径 来 测试 有 关 轴 垂直 于 XY 平面 的 旋转 。 采 用 前 面相 同 的 设计 参数 ， 权 重 
值 调整 10" 次 和 迭代 后 收 仿 。 偏 航 误差 可 以 表示 为 

E, =f yaw y (3 Wyau) (5.16) 

基于 RBF 模型 的 输出 与 实际 误差 测量 非常 接近 ， 如 图 5. 27 所 示 。 

4. 垂直 度 误差 

两 轴 之 间 的 垂直 度 表征 了 两 轴 相 对 对 方 定位 90" 标 称 方向 的 偏离 。 它 主要 发 
生 在 装配 阶段 ， 而 且 也 难以 准确 地 确定 轴 和 了 轴 之 间 的 直角 。 垂 直 度 测量 可 
以 使 用 两 个 直线 度 测量 ， 通 过 参考 其 中 一 个 轴 90° 作 出 。 在 这 个 试验 中 ,了 轴 选 
择 作为 垂直 度 测量 的 参考 线 ， 即 相对 于 Y 轴 的 了 轴 的 直线 度 测量 ， 由 于 垂直 度 


- 118 - 精密 运动 控制 : 设计 与 实现 

















偏 航 误差 (7 轴 ) 的 RBFVarcsec 





0 10 20 30 40 50 60 70 80. 90 100 
位 置 /mm 
5.27 偏 航 误差 CY RH) 的 RBF it ( 实 线 是 基于 RBF 逼近 ， 圆 圈 代 表 实 测 数据 ) 
测量 只 产生 一 个 单一 141arcsec (2.24°) 的 常数 ， 不 需要 RBF 模型 逼近 。 在 这 种 


EF, RANEH a= 14larcsec。 
5.9.3 试验 


XY 工作 台 用 来 作为 研究 的 测试 台 。 附 加 到 工作 台 的 器 具 可 在 任意 的 三 或 了 
方向 上 移动 。 可 以 在 一 个 100mm x 100mm 的 二 维 空间 做 XX 和 Y 方 向 同时 运行 。 
电子 四 倍 插值 后 ， 数 字 编 码 器 分 辩 率 为 2.5pm， 这 也 对 应 了 最 小 步 长 。 电 动机 
使 用 螺杆 将 旋转 运动 转化 为 直线 运动 ， 因 此 可 知 可 能 存在 很 高 程度 的 非 线性 位 移 
误差 。 在 这 种 情况 下 ， 线 性 插值 是 不 够 的 。 如 果 要 满足 高 精度 的 要 求 ， 必 须 建 立 
非 线性 误差 模型 。 图 5. 28 所 示 为 试验 所 使 用 的 XY 平台 。 本 节 的 主要 目标 是 以 更 
完善 的 校准 方法 ,减少 由 XY 工作 台 几 何 误差 产生 的 定位 误差 。 





图 5.28 XY 工作 台 


1. XY 工作 台 的 校准 
误差 建 模 一 般 从 误差 校准 开始 ， 误 差 校 准 选 定 的 点 在 机 器 操作 空间 的 范围 
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内 。 对 于 一 个 三 维 工作 空间 ， 由 此 产生 的 几何 定位 误差 可 能 分 解 成 21 个 相关 部 
分 (Satori 等 1995)。 由 于 XY 工作 台 具 有 零点 补偿 功能 ， 误 差 来 源 减 少 到 六 个 部 
分 ,包括 两 个 线性 误差 、 两 个 直线 度 误 差 、 一 个 角 误 差 和 针 轴 与 了 轴 的 正 交 误 
差 。 这 些 误差 可 以 精确 测量 ， 利 用 诸如 激光 干涉 仪 的 独立 计量 系统 ， 通 常 可 以 按 
lum 的 移 位 精度 来 测量 直线 位 移 ， 按 0. 002arcsec 的 精度 测量 角 位 移 。 这 些 误差 
随后 可 以 利用 总 体 误差 模型 累计 产生 整体 位 置 误差 。 
2. 评估 误差 补偿 
基于 RBF 利用 各 自 的 几何 误差 模型 ， 误 差 补偿 可 以 这 样 进行 。 基 于 RBF 模 
型 通 近 的 误差 补偿 ,误差 是 
Ax = fing (25 Win) + Y Wan) (5. 17) 
Ay =finy (Y5 Wainy) + fra CX; Wore) + Fay Y5 Wyowy ) % — Ox (5. 18) 
注意 x, =y, =0， 因 为 在 这 个 试 "9) 
验 中 没有 使 用 取样 器 。 用 RBF i 
近 误 差 补 偿 是 通过 使 用 MATLAB 
实现 的 。 为 了 评估 误差 补偿 ， 两 
轴 伺 服 控制 的 托 架 沿 着 工作 区 的 
两 条 对 角 线 移动 ， 如 图 5.29 所 
示 。 这 提供 了 一 个 合理 衡量 基于 
RBF 模型 是 否 合适 的 基础 ， 并 
符合 英国 标准 (1989 Æ) 推荐 Y/mm 
的 方法 。 图 5.29 对 角 线性 能 试验 
使 用 惠普 激光 干涉 仪 系统 沿 对 角 线 测量 线性 误差 。 沿 对 角 线 采用 或 不 用 误差 
补偿 测量 了 10 个 点 的 线性 位 移 。 图 5. 30 所 示 为 沿 XY 工作 台 对 角 线 运动 的 线性 
误差 , 互 轴 和 了 轴 伺 服 控制 正 向 从 人 台 角 4 到 对 面 台 角 D 运动 ; 图 5.31 所 示 为 沿 
SÉ 她 正 向 运动 到 对 面 角 C 的 补偿 直线 误差 。 
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图 5.30 ”补偿 后 4-D 方 向 的 对 角 线 误差 
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图 5.31 补偿 后 B-C 方 向 的 对 角 线 误差 


相 比 之 下 ， 同 样 的 位 置 预测 对 角 线 误差 的 不 补偿 校准 如 图 5. 32 和 图 5. 33 所 
示 。 对 于 同样 的 对 角 线 ， 显 然 对 角 线 误差 已 经 减少 ， 从 约 160pm 到 RBF 方法 补 
偿 后 的 小 于 55pm, 
































30[ 一 一 一 
25} = 
= o 2 
= al ° ° e © o ° 
aH | 2 ° 
HK 10- e o 8 ° o 
K > o (d 
oe 。 
£ of o . g g 
Fi ° 
Q ol o e 
* 155 | 
o 1 
-205 30 om) 700 750 
` mm 
图 5.32 补偿 前 A-D 方向 的 对 角 线 误差 
Oe = — 
E£ —20F ° © 
< 4 o ° 
27 
Z. -6o 上 ° s ° 8 ° 
x o o 
A -807 ° ° o o ° ° ° s 
o 
= -100} o _ z 
R -120 o ° o o 
S -140} e 
-1605 30 位 置 /mm 100 0 


图 5.33 补偿 前 B-C 方向 的 对 角 线 误差 
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5.9.4 ”使 用 多 层 神经 网 络 误差 建 模 


几何 误差 也 可 以 利用 多 层 
神经 网 络 (NN) 建 模 。 使 用 
多 层 神经 网 络 的 逼近 精度 是 普 Lm 
饥 优 于 使 用 线性 双 层 RBF 的 。 。， SR 
此 外 ， 对 近似 准确 度 的 同一 系 ut 
统 ， 多 层 神经 网 络 的 神经 元 数 
目 都 不 可 能 比 在 直线 参数 点 上 
RBF 通 近 的 权 数 来 得 少 。 利 用 Wy 
多 层 神经 网 络 误差 建 模 的 主要 
原则 将 在 本 节 进 行 重点 介绍 。 

一 个 三 层 神 经 网 络 的 基本 
结构 如 图 5.34 所 示 。 三 层 神 图 5.34 多 层 神经 网 络 的 基本 结构 
经 网 络 可 以 用 来 逼近 任意 连续 
函数 到 所 需 的 精度 。 给 定 了 了 e R"， 一 个 三 层 神 经 网 络 有 一 个 网 络 输出 为 
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Ni N 


No 
Xx, = f(X;W) = 2 fy [wer 人 > W,X, + Oy) + 0] }+ 6, k=1,-,N, 
jl i=l 


(5.19) 
Riio( +) 激活 函数 ，W; 是 第 一 层 至 第 二 层 互 连 权 重 ; Wi 是 第 二 层 到 第 三 层 
的 互 连 权 重 。9v 和 9; 是 阐 值 偏 移 。 通 常 ， 神 经 网 络 合适 的 权 值 和 立 值 采用 离线 
或 在 线 通 近 的 方法 获得 ， 即 应 该 表现 出 神经 网 络 的 “学 习 行 为 ”。 

要 获取 神经 网 络 权重 WR， 采 用 适当 的 权重 校正 算法 。 一 个 常用 的 权重 校 
正 算法 是 基于 反 向 传播 误差 的 梯度 搜索 算法 ， 如 神经 网 络 进行 离线 训练 匹配 
HERRI (xas Ya), ，x 是 神经 网 络 的 理想 输入 ，Ys 是 神经 网 络 产生 的 
预期 输出 。 学 习 过 程 的 目的 是 通过 适当 调整 学 习 参 数 ， 驱 使 总 误差 接近 零 。 
这 基本 上 构成 了 一 个 由 梯度 搜索 技术 试图 解决 的 最 小 化 问题 。 随 着 隐 节 点 适 
当 的 选择 ， 通 常 可 以 带动 网 络 接近 理想 的 准确 性 。 通 常 ， 可 以 通过 指定 大 量 
网 络 结构 的 隐 节 点 ， 或 开始 有 少数 隐 节 点 单元 ， 增 加 隐 节 点 数量 直到 近似 误 
差 在 小 阐 值 范围 内 。 : 

对 于 几何 误差 建 模 的 应 用 ， 这 里 的 神经 网 络 可 以 被 设计 为 一 个 单 输入 单 输出 
(SISO) 的 函数 。 输 入 直接 连接 到 一 个 神经 元 节点 。 输 入 将 与 各 自 编码 器 的 标 称 
测量 对 应 。 神 经 网 络 的 输出 将 力图 紧 随 激光 测量 ， 必 要 时 可 采用 非 线性 插 补 。 基 
于 神经 网 络 反 向 传播 误差 的 梯度 搜索 算法 总 结 如 下 : 

(1) 计算 输入 层 的 输出 已 
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X, -— 
1 +exp( -0, +a) 
其 中 ，0, = WX ,XX 是 神经 网 络 (或 输入 样本 ) 的 输入 。 
(2) EBEKRE Xy 
1 





X; =] Fap O, -0.) (5.20) 
其 中 ， O01 = WX, , j=l, 2, ++, No 
(3) 计算 输出 层 的 输出 X,, 
N 
Xy = È WX +0, (5.21) 
£ 


RH, X, 是 神经 网 络 的 输出 。 
(4) 更 新 从 隐 层 到 输出 层 的 权重 Wa 
Win = Wi + 6X (5. 22) 
其 中 , 2 = - (Xs -Xo) 与 和’ 为 期 望 的 输出 (或 输出 采样 )，X 作 为 神经 网 
络 的 输出 。 
(5) 更 新 从 输入 到 隐 层 的 权重 Wy 
w =W; + UR (5.23) 
EH, ôy = [8 Wn 1X, -Xy,). 
(6) 更 新 输出 层 权 值 W, 
W, =W, +738X,, (5.24) 
其 中 ,5 = [E 8M 1K, -总 )。 
(7) 更 新 闻 值 2 Oyj, Oo 
A = 6, +716; 0; = 6; + 12982; > Oor = O01 + Mos (5. 25) 
HP, m, Ny» Ns» Mer Nee» ?36 都 大 于 零 ， 是 增益 因子 。 
训练 过 程 终止 条 件 通常 是 以 下 公式 : 
e =D (XS = Xi)? (5. 26) 
其 中 , /代表 样本 数 。 迄 代 权 重 校 正 过 程 终 止 时 ,误差 收 合 在 一 个 指定 的 阐 值 范 
围 内 。 因 此 ， 可 以 得 到 最 佳 的 权重 WW。 训练 通常 是 在 迭代 合适 的 质量 和 时 间 上 的 
一 个 折 中 。 由 于 训练 过 程 可 以 做 到 离线 ， 所 以 更 多 强调 要 考虑 的 是 在 一 个 较 长 的 
调整 时 间 中 得 到 一 个 更 好 的 和 迭代 结果 。 
这 样 ， 该 神经 网 络 可 以 应 用 于 对 单个 几何 误差 分 量 建 模 ， 类 似 使 用 RBF 时 
的 情况 。 
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5.10 ”随机 误差 的 机 械 补偿 


任何 误差 软件 补偿 计划 的 成 效 非 常 依赖 于 由 规定 的 校准 方法 获得 的 几何 误差 
信息 的 可 靠 性 。 通 过 误差 补偿 ， 系 统 组 成 部 分 的 几何 误差 是 相关 的 。 随 机 性 质 的 误 
差 不 能 得 到 补偿 。 机 械 校准 过 程 中 获得 的 误差 测量 将 不 可 避免 地 包含 系统 误差 和 随 
机 误差 两 个 部 分 。 为 正确 补偿 系统 误差 ， 有 效 地 分 开 这 两 个 组 成 部 分 是 至 关 重 要 
的 。 现 有 的 误差 补偿 方法 中 大 多 数 都 没有 充分 解决 系统 误差 补偿 中 随机 误差 的 影 
响 。 补 偿 的 几何 误差 通常 以 误差 校准 样本 的 平均 值 为 基准 。 这 个 均值 基本 上 假定 为 
一 致 的 系统 组 件 可 补偿 的 误差 ， 因 为 随机 误差 假设 是 过 滤 后 的 过 程 平均 值 。 不 幸 的 
是 ， 基 本 上 这 是 不 正确 的 ， 平 均值 的 补偿 可 能 导致 严重 不 当 的 补偿 ， 尤 其 是 当 校 准 
过 程 中 存在 着 明显 的 随机 误差 。 在 校准 工作 中 ， 由 于 短期 和 暂时 的 干扰 或 噪声 出 现 
的 无 效 样本 或 异常 值 ， 可 以 扭曲 平均 值 偏 离 实际 的 系统 误差 ， 因 而 使 用 误差 平均 值 
可 能 导致 不 足 或 过 多 补偿 。 因 此 ， 采 用 一 种 加 权 方 法 考虑 在 误差 样本 中 不 同 程度 的 
随机 误差 分 量 发 生 的 概率 ， 可 以 更 准确 和 更 可 靠 地 提取 系统 误差 补偿 的 数据 集 。 这 
样 的 统计 方法 需要 大 样本 集 进行 校准 ， 以 便 有 足够 大 的 数据 存储 密度 运作 。 这 样 也 
导致 了 自动 化 技术 、 基 于 DSP 的 数据 记录 和 分 析 系 统 的 应 用 。 

本 节 将 介绍 一 个 减少 随机 误差 不 利 影响 的 统计 方法 ， 这 种 方法 是 校准 数据 集 
上 的 系统 误差 补偿 中 不 可 缺少 的 一 部 分 。 其 基本 思路 是 推断 和 隔离 数据 集 的 系统 
几何 误差 分 量 ， 通 过 适当 分 析 随 机 误差 幅度 的 概率 ， 确 定 系统 几何 误差 分 量 渗透 
的 随机 数据 。 该 方法 简单 ， 直 接 适 于 实际 应 用 。 它 包括 三 个 主要 步骤 : 首先 ， 收 
集 几何 误差 误差 带 被 分 解 成 依次 相 续 的 类 。 其 次 ， 基 于 属于 类 的 数据 集 的 密度 
将 属于 每 个 类 的 随机 误差 的 概率 进行 计算 。 这 些 概率 用 于 统计 分 析 ， 从 系统 误差 
数据 集 推导 出 最 有 可 能 的 误差 。 最 后 ， 在 推导 出 统计 误差 的 基础 上 进行 补偿 。 随 
机 误差 的 影响 包括 那些 因 出 现 间 软 性 故障 、 噪 声 和 干扰 的 影响 ， 这 种 统计 方法 可 
以 在 很 大 程度 上 消除 并 分 离 对 补偿 效果 不 利 的 影响 。 当 机 械 的 精度 要 求 相应 较 高 
时 ， 这 种 优势 就 更 加 显著 。 下 面 提供 了 一 个 单 轴 压 电 陶 次 运动 系统 的 非 线性 误差 
补偿 的 试验 结果 。 与 预期 结果 一 致 ， 试 验 结果 表明 相对 于 误差 补偿 的 传统 方法 ， 
统计 误差 补偿 方法 得 到 了 不 同 的 均值 。 增 强 的 补偿 结果 可 以 实现 。 


5.10.1 概率 方法 


随机 误差 8(x) 定义 为 实际 误差 测量 对 整个 数据 集 计算 均值 的 偏差 。 在 数学 
上 上 ， 可 以 表示 为 
5(x) =Ay(x) -A y(x) (5. 27) 
AP, Ay 是 实际 的 误差 测量 ，Ay 是 上 述 数据 集 导 出 计算 的 均值 ， 即 
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-1 
Ay = » Ay (5. 28) 


n 是 测量 的 总 数目 。 在 一 般 情 况 下 ， 数 学 期 望 E[6] =0。 

众所周知 ， 只 有 系统 误差 可 以 进行 补偿 ， 所 以 最 好 通过 适当 的 系统 设计 将 在 
校准 过 程 中 可 能 发 生 的 随机 误差 尽量 减少 ， 因 为 它们 是 不 能 得 到 补偿 的 。 在 本 节 
中 正在 介绍 的 主要 困难 不 是 企图 补偿 随机 误差 ， 而 是 减少 随机 误差 对 系统 误差 补 
偿 产生 的 不 利 影响 ， 因 为 系统 性 和 随机 部 分 两 者 同时 存在 于 相同 的 误差 测量 之 
中 。 我 们 面临 的 挑战 是 如 何 有 效 地 分 离 出 这 两 个 组 成 部 分 ， 以 便 可 以 基于 纯粹 的 
系统 误差 进行 补偿 。 

大 多 数 方法 使 用 A7 作 最 终 的 补偿 。 在 这 些 方法 中 ，Ay 假定 不 受 随 机 误差 的 
影响 ， 因 此 它 相 当 于 系统 误差 的 部 分 ， 可 以 得 到 补偿 。 不 幸 的 是 ， 大 量 的 随机 误 
差 出 现在 误差 测量 中 ， 这 些 方法 会 产生 一 个 严重 不 足 的 补偿 。 由 于 短期 和 暂时 的 
干扰 或 噪声 可 以 扭曲 实际 系统 误差 的 平均 偏 置 ， 无 效 的 样本 或 异常 值 会 在 校准 工 
作 中 出 现 ， 因 此 ， 只 用 样本 均值 可 能 导致 不 足 或 过 度 补偿 。 可 以 用 加 权 方 法 滤 除 
随机 误差 的 影响 ， 使 用 的 统计 分 析 可 以 用 来 为 系统 误差 的 机 械 补偿 提取 更 准确 和 
更 可 靠 的 数据 。 

为 此 ， 该 误差 带 被 分 成 子 类 。 考 虑 2 +1 MRŽX s, j=0, +1, +2, =, 
+ 上 组 成 的 一 维 空间 ， 由 式 (5.27) 定义 的 随机 误差 8 假设 落 入 * 类 ， 则 

(2j-1)L<8<(2j+1)L = j=0, 41, 42,---, +k (5. 29) 
其 中 , 工 是 类 的 大 小 。 同 时 ， 每 类 的 大 小 最 好 是 尽 可 能 小 ， 以 便 最 大 化 整个 类 的 
误差 分 辩 率 ， 一 个 小 工 需 要 一 个 大 的 数据 集 。 因 此 ， 实 际 使 用 每 个 类 的 大 小 应 依 
赖 于 采集 原始 数据 集中 的 可 用 资源 。 

类 误差 样本 的 数量 属于 这 些 类 的 幅度 ， 可 以 计算 出 随机 误差 概率 。 如 果 类 s, 
4a n 随机 误差 的 样本 ， 则 

P(s, =“ (5.30) 
这 种 概率 定义 显然 满足 了 nro 公理 化 的 理论 。 

理想 情况 下 ， 如 果 A7 代表 一 个 几何 误差 的 组 成 部 分 ， 大 多 数 随机 误差 期 望 
能 在 s 集合 所 包含 ， 即 含有 随机 误差 类 5 = 0 应 该 是 对 应 概率 最 高 。 否 则 ， 任 何 
随机 误差 偏差 现象 应 用 来 抵消 误差 均值 ， 以 便 对 系统 性 误差 分 量 进行 更 准确 的 重 
构 。 这 个 均值 偏差 5 可 以 从 关于 各 种 误差 类 的 概率 (P(s),j=0, +1, +2,…， 
+k) 中 获得 


ô = J, 6,P(s,) (5.31) 


EH, 6, =2L BS s 类 的 中 点 ， 即 [ (2 -1)L, (2 +1)L]。 因 此 ， 在 统计 意义 
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上 “最 可 能 ”的 系统 误差 可 以 计算 为 Ay +6。 
最 后 ， 可 在 此 基础 上 按 推 导出 的 统计 系统 误差 进行 误差 补偿 。 


5.10.2 试验 


本 节 中 的 试验 结果 说 明了 统计 方法 的 有 效 性 ， 适 用 于 线性 压 电 陶 瓷 运 动 系统 
的 非 线 性 误差 补偿 。 试 验 装置 如 图 5. 35 所 示 。 





图 5.35 ”试验 装置 


使 用 的 压 电 陶 瓷 电 动机 是 Nano Motion 有 限 公 司 制造 的 单 轴 伺服 电动 机 ， 它 
有 一 个 0. lum 有 效 分 辩 率 的 光学 编码 器 。 随 机 误差 产生 的 主要 来 源 包括 : 接触 
摩擦 条 件 变化 、 黏 滑 效应 、 移 动机 械 间 隙 、 轴 承 单元 变形 、 传 感 器 电子 电路 瞬 
变 、 环 境 温度 变化 及 轻微 的 结构 振动 。 

使 用 dSPACE 控制 开发 和 快速 原型 系统 ， 特 别 是 集 所 有 功能 于 一 身 的 
DS1102 板 ， 用 来 达到 校准 和 补偿 的 目的 。 误 差 补 偿 用 内 人 Simulink 控制 块 查 表 
的 形式 进行 。 

校准 使 用 激光 干涉 仪 在 50mm 沿线 每 隔 Smm 的 一 个 特定 点 位 上 进行 。 因 此 ， 
压 电 陶瓷 电动 机 线性 误差 沿 直线 在 10 个 点 上 进行 测量 。 图 5. 36 所 示 为 收集 的 原 
始 数据 集 ， 这 些 点 分 别 来 自 40 个 完整 的 双向 运动 ， 即 n=40。 由 这 40 个 点 样本 
计算 的 每 个 平均 值 如 表 5. 1 所 示 。 

组 合 的 误差 数据 带 分 解 到 工 =2jm 的 子 类 ,计算 相应 在 每 一 类 范围 内 随机 误 
差 的 概率 。 图 5.37 ~ 图 5.39 明显 显示 了 随机 误差 零 偏 置 现象 。10 点 的 8 个 校正 
位 置 中 落 人 so 类 随机 误差 的 概率 低 于 s, 类 随机 误差 的 概率 。 这 表明 ， 样 本 平均 
值 不 能 充分 反映 实际 存在 的 系统 误差 。 
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图 5.36 原始 数据 集 的 线性 误差 
表 5.1 均值 误差 
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图 5.37 误差 的 概率 分 析 (5 ~20mm) 
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图 5.38 误差 的 概率 分 析 (25 ~40mm) 





x=45mm x=50mm 
35 35 
30 30 
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£ 20 = 20 
x 15 x 15 
10 10 
5 5 
0 0 —t 
6-4-2 0 2 4 6 6-4-2 0 2 4 6 
误差 /hm 误差 /hm 


图 5.39 误差 的 概率 分 析 (45 ~50mm) 


然后 ,根据 这 些 平均 值 作出 补偿 。 在 同一 位 置 补偿 后 进行 了 重新 校准 ， 试 验 
结果 如 图 5. 40 ~ 图 5.42 所 示 。 正 如 预期 的 那样 ， 从 这 些 图 来 看 ， 很 明显 ， 经 过 
补偿 ,“ 似 乎 ”随机 误差 类 继续 展示 出 so 类 的 强烈 偏 置 。 
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补偿 后 概率 分 析 均 值 (5 ~20mm) 


























x=5mm 
70 
60r 
50} 
40F 
30} 
207 
107 
L L 1 E 上 
0 -6-4-2 0 2 4 6 
误差 /hm 
x=15mm 
70 
60+ 
50} 
40+ 
30+ 
207 
107 
1 L 4 I l 
0 -6-4-2 0 2 4 6 
误差 /hm 
图 5.40 
x=25mm 
70 
60r 
50} 
40 
so 
20r 
10r 
L L L h L 
0 6-4-2 0 246 
误差 /hm 
x=35mm 
60 
SOF 
40+ 
30 
20) 
10+ 
1 l 1 i 1 
0 -6-4-2 0 2 4 6 
误差 /hm 
图 5.41 


概率 (%) 


概率 (%) 


x=30mm 











| 
© 

| 
小 

1 
kb 
oC 
N 
m 
aot 








补偿 后 概率 分 析 均 值 (25 ~40mm) 











第 5 章 “几何 误差 补偿 . 129 . 





























x= 45mm x=50mm 
70 70 
60) 60) 
50 SOF 
& 40 £ ao} 
W 30 St 30t 
E yè 
20 207 
10 10 
L i 1 量 1 1 1 L 1 1 
0 6-42 024 6 0 -6-4-2 0 2 4 6 
误差 /hm 误差 /um 


图 5. 42 补偿 后 概率 分 析 均 值 (45 ~ 50mm) 


使 用 统计 方法 计算 均值 偏差 (8) 如 表 5. 2 所 示 。 这 些 值 用 来 调整 表 5.1 的 
补偿 平均 值 。 误 差 补偿 后 对 相同 的 10 个 位 置 再 次 进行 校准 ， 补 偿 后 所 产生 的 随 
机 误差 如 图 5.43 ~ 图 5.45 所 示 。 相 对 于 图 5.40 ~ 图 5.42， 这些 图 中 偏 置 现象 已 
大 为 减少 。 统计 方法 在 随机 误差 的 影响 下 已 经 取得 了 对 系统 误差 更 准确 的 补偿 。 





表 5.2 均值 偏差 
采样 点 /mm 5 10 15 20 25 30 35 40 45 50 
均值 偏差 swpm | 2 2 0 2 1 0 2 2 1 2 
x=5mm x=10mm 
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图 5.43 补偿 后 概率 分 析 (5 ~20mm) 
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图 5.45 补偿 后 概率 分 析 (45 ~ 50mm) 





第 6 章 电子 插值 误差 


运动 控制 的 高 精度 和 分 辩 率 严重 依赖 于 编码 器 测量 的 位 置 精度 和 分 辩 率 。 这 
些 因素 反 过 来 又 受 该 编码 器 制造 技术 的 限制 。 迄 今 为 止 ， 线 性 光学 编码 器 光栅 尺 
可 以 制造 出 不 到 4pm 的 不 同 间距 。 但 很 明显 ， 在 制造 过 程 中 间距 进一步 减少 ， 
要 受 物理 因素 极 大 的 制约 。 这 意味 着 目前 实现 的 1pm 光学 分 辩 率 是 四 们 插值 后 
得 到 的 。 使 用 模拟 插值 软件 技术 引起 了 人 们 的 兴趣 ， 可 以 进一步 地 提高 编码 器 的 
分 辩 率 ， 可 以 在 线 处 理 编码 器 模拟 信号 产生 小 中 间 位 。 

这 种 方式 获得 的 相关 位 置信 息 的 误差 源 可 分 为 间距 误差 和 插 补 误差 。 间 距 误 
差 是 由 于 制造 比例 公差 和 安装 失真 产生 的 。 它 们 一 般 可 以 通过 几何 误差 补偿 同样 
的 程序 进行 补偿 。 与 插值 误差 相 联系 的 间距 内 细 分 精度 将 影响 所 有 完成 的 校准 结 
果 。 编 码 器 的 理想 信号 是 一 对 正弦 波 ， 它 们 之 间 具 有 正 交 相 位 差 。 插 值 处 理 这 些 
成 对 的 正弦 波幅 度 和 相位 的 相对 差 。 如 果 插 值 计算 时 ， 这 个 周期 对 信号 偏离 理想 
波形 ， 插 值 误差 将 会 出 现 。 插 补 前 必须 纠正 这 些 偏差 ， 采 用 数字 信号 处 理 技术 减 
少 插值 误差。 

本 章 将 介绍 电子 插值 误差 的 性 质 及 解决 这 些 误差 校准 和 补偿 问题 的 各 种 
方法 。 


6.1 海德 曼 插 值 法 


模拟 编码 器 的 信和 号 往往 偏离 理想 的 正 交 正 弦 信 号 。 对 两 正 交 正弦 信号 补偿 均 
值 误差 ， 相 位 和 幅度 误差 的 技术 最 初 是 由 海德 曼 (Heydemann) 1981 年 建立 的 。 
他 用 最 小 二 乘法 拟 合 有 效 地 计算 这 些 误 善 分 量 ， 并 为 两 个 非 理 想 的 正弦 信号 进行 
了 校正 。 使 用 这 种 方法 ， 伯 奇 (Birch) 1990 年 以 纳米 精度 计算 出 光 的 边缘 部 
位 。 通 过 利用 角 振 幅 的 变化 ， 伯 奇 将 一 正弦 信号 周期 分 成 Y 段 等 角 ， 以 有 效 增 
加 电气 角 分 辩 率 。 下 面 介绍 海德 曼 插值 法 的 原理 。 

定义 u Alu, 分 别 为 理想 的 相位 正 交 信 号 。 正 弱 信 号 相互 差 m/2 相同 相位 为 

u, = 4cos5 

u, = Asind 
其 中 ,6 表示 的 瞬时 相位 。 如 果 这 些 信 号 用 来 制作 李 萨 如 (Lissajous) RJE, 将 
获得 一 个 旋转 向 量 来 描述 半径 4 的 圆 。 向 量 的 一 个 旋转 周期 ， 相 当 于 一 个 2 光 
学 相 变 。 瞬 时 相位 5 可 直接 获得 
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Uz 
ô = arctan — 
ui 


8A -n 2 到 mm 2 变化 ,而 为 了 便于 边缘 分 离 ， 期 望 的 相位 范围 为 0 到 2m。 这 
可 以 通过 适当 的 极 性 调整 获得 
0=6+0g 
其 中 , o =0, u, u,>0, 
=m, u, <0, 
=2T，L >0, u <0, 


从 编码 器 的 角度 来 看 ，9 对 应 一 个 增 量变 化 Ax， 为 


8 
Ax = In 


H, x, 是 比例 尺 的 间隔 周期 。 因 此 ，8 识别 的 分 辩 率 可 确定 用 特定 的 光学 编码 
器 获得 的 最 大 揪 值 。 使 用 商用 12 位 A/D 转换 器 可 以 进行 4096 次 插值 。 理 论 上 ， 
任意 的 高 密度 插值 都 可 以 用 足够 长 的 A/D 转换 器 实现 。 

但 实际 情况 是 编码 器 的 信号 将 偏离 期 望 值 。 首 先 ， 实 际 信号 可 能 有 不 同 的 均 
E, DIA m 和 m,， 主 要 是 由 于 电子 信号 处 理 偏 置 的 影响 。 其 次 ， 由 于 相关 的 
检测 系统 增益 变化 它们 的 幅度 可 能 不 一 样 。 它 们 的 比例 记 为 C = 4,/4,， 在 理想 
情况 下 ，C =1。 第 三 ， 可 能 有 rw 2 相 移 顶端 的 附加 相 移 se。 最 后 ， 还 存在 波形 
失真 、 噪 声 及 任何 漂移 的 影响 ， 这 就 意味 着 由 于 非 理 想 因素 ， 环 境 因 素 也 可 能 会 
随时 间 慢 慢 变 化 。 

因此 ， 实 际 编码 器 信号 的 描述 方程 为 

U, =u, +m, 


~ _Asin(d-€) u,cose — wisine 
t, == +m, = 一 一 一 + 
G 


G ma 


A =(Ñ, m)? i, ~m,)C +( Ñ, ~m,)sine | 





cos’€ 
直接 简化 为 
ki 十 有 并 (6.1) 
其 中 
k, = [A’cos’e -ml -Cm -2Gm,m,sine] ~' 
ky =k, 
k, =2k, Gsine 


k, = -—2k, [m, + Gm,sine | 
ks = -2k,G [Gm, +m,sine ] 
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方程 (6. 1) 为 线性 参数 化 形式 ， 适 合 使 用 最 小 二 乘法 拟 合 ， 得 出 五 ~ 应 的 
常规 估计 ， 从 这 些 补偿 参数 可 以 得 出 如 下 


. k, | 
€ = arcsipn| 一 一 -一 
| /和 大 
k, 
an 
2k,k, — ksks 
m= 4,7. 
ks -4k k, 
_2kiks -ksk 
m= Ak ky 
Ax /4k, (1 +k m? + km +k,m,m,) 





dk ky -k 
这 样 得 出 的 估计 数 是 无 偏 的 ， 并 且 使 用 更 大 的 数据 集 可 以 减少 噪声 的 影响 
(方差 ) 。 因 此 ， 校 正信 号 Au, 为 
到 =(u,-m,)7A 


_ (u, -m ) sine + G(u, 一 ma) 
2.7 


~ 





Acose 


该 校正 相位 可 得 ”. 


一 uy 
ô = arctan — 
u 


据 此 可 以 计算 出 6， 相 对 位 移 推导 出 


6.1.1 插值 界 


为 了 使 移 位 Ax 可 以 按 分 辨 率 尺 得 到 测量 ，0 必须 满足 9, <0. SR 的 分 辩 率 。 
因此 ， 如 果 R =0. 01pm， 相 位 必须 得 到 一 个 0, =0.0157 弧度 的 分 辨 率 。 这 带 来 
Xu, Mu, 信号 测量 直接 产生 的 精度 要 求 。 表 6. 1 所 示 为 海 登 海 因 (Heidenhein) 
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线性 编码 器 LIP401 测量 精度 要 求 ， 它 具有 4um 的 典型 信号 周期 与 峰 峰 值 电压 为 
LV 的 模拟 信号 输出 。 

信和 号 测量 精度 也 决定 了 理想 搬 值 所 人 允许 的 最 大 噪声 振幅 。 相 反 ， 给 定 噪声 幅 
度 ， 可 实现 的 编码 器 插 补 也 是 固定 的 ， 而 不 论 测量 精度 如 何 。 


表 6.1 推荐 信号 测量 分 辨 率 
位 置 分 辩 率 及 hm 信号 分 辨 率 /V 
40 0.1 0. 05 
400 0.01 0. 005 
0. 001 0. 0005 


A/D 转换 位 长 度 /位 
5 



























6.1.2 校准 和 补偿 


沿 着 比例 尺 低速 移动 编码 器 头 越过 比例 尺 整 个 长 度 可 得 到 信号 2, 和 立 ,。 
偏 移 量 参 数 可 从 编码 器 具体 指示 的 信号 中 获得 。 插 值 误 差 es 相应 计算 得 出 。 

该 插 补 误差 补偿 的 过 程 为 : 首先 ， 越 过 光学 尺度 的 整个 长 度 来 校准 误差 。 其 
K, 误差 建 模 ， 通 常用 非 参 数 形式 ( 如 一 个 查 表 ) ， 或 者 使 用 参数 模型 。 最 后 以 
误差 模型 为 基础 在 线 进行 误差 补偿 。 


6.2 增强 插值 法 


海德 曼 插值 方法 通常 需要 确定 的 高 精度 控制 系统 模 / 数 转换 器 和 一 个 计算 
所 需 分 辨 率 电 角度 的 高 速 DSP。 因 此， 海德 曼 插值 方法 并 不 适用 于 只 有 数字 增 
量 编码 器 接口 的 典型 何 服 控制 器 。 此 外 ， 该 方法 还 结合 繁琐 的 正弦 插值 校正 ， 
自 校正 参数 校准 必须 离线 进行 。 因 此 ， 能 够 提供 捅 值 的 大 多 数 伺服 控制 器 ， 都 
假设 有 完美 正 交 正 弦 信 号 。 有 关 的 分 辩 率 规格 可 以 实现 ， 但 伴随 的 准确 性 无 法 
得 到 保证 。 正 艾 电流 的 校正 效果 也 没有 考虑 波形 失真 的 形状 误差 ， 即 实际 的 信 
号 可 能 是 周期 性 的 ， 但 未 必 是 完全 正弦 。 对 亚 微米 级 的 分 辨 率 和 精度 要 求 ， 这 
当然 属于 严重 的 误差 。 

本 节 提 出 了 一 种 新 的 方法 ， 它 独立 于 伺服 控制 器 来 进行 校正 和 插值 。 因 此 ， 
该 方法 适用 于 大 多 数 伺服 控制 器 ， 包 括 只 有 数字 增 量 编码 器 接口 的 伺服 控制 器 。 
其 基本 思路 是 基于 现 有 的 编码 器 正 交 正弦 信号 获得 高 阶 正弦 波 。 这 些 高 阶 信号 叉 
可 以 转换 为 一 系列 二 进 制 的 高 频 脉 冲 ， 可 随时 按 标准 伺服 控制 器 解码 。 用 一 个 查 
表 来 实现 很 少 计算 要 求 的 想法 。 正 弱 校 正 包括 平均 值 和 相位 偏 移 、 振 幅 差异 和 波 
形 失 真 ， 可 直接 在 查 表 反映 。 该 表 可 以 自 适应 在 线 更 新 ， 以 反映 随后 的 任何 修改 
或 编码 器 信和 号 的 漂移 。 仿 真 和 试验 结果 提供 了 实现 的 原理 和 方法 ， 以 及 增强 插值 
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方法 的 适用 性 。 
6.2.1 增强 插值 法 的 原理 


该 强化 的 插值 方法 的 基本 思想 是 由 基础 信号 获得 高 阶 正弦 信号 。 由 这 些 信号 
可 以 生成 二 进 制 脉冲 ， 可 随时 为 位 置信 息 由 标准 的 伺服 控制 器 进行 解码 。 例 如 ， 
由 sina 和 cosa 值 ，sin2a 和 cos2a 可 从 三 角 关 系 得 到 
sin2a =2sinacosa 
a (6.2) 
cos2a = 1 -2sin a 
一 般 来 说 ， 假 设 sina 和 cosa 是 足够 精确 已 知 的 ，sinna 和 cosna (ne Z>1) 
可 以 从 下 面 的 通用 方程 推导 
sinna = mcos" ia - Cacos" asin a 
+ Cocos” asina -+ (6.3) 
cosna = cos"a — C2cos”~* asin’ a 
+ Cicos" asinta -+ 
使 用 电子 比较 器 来 检测 跨越 零 ， 从 正 交 二 进 制 脉冲 也 可 获得 sinna 和 cosna。 
使 用 标准 的 伺服 控制 器 或 数控 系统 ， 这 些 脉冲 更 容易 解码 位 置信 息 。 从 这 些 信和 号 
还 可 获得 4 倍 插值 信号 。 这 种 方法 省 去 了 为 插值 目的 在 控制 系统 中 设置 精确 模 / 
数 信号 采集 和 处 理 单元 ， 因 为 播 补 已 独立 于 控制 器 完成 。 
查 表 将 作为 推断 引擎 来 提供 的 信号 插值 ( 见 6.2.2 节 的 内 容 ) 。 原 编码 器 信 
号 的 误差 可 直接 在 查 表 的 条 目 中 反映 而 不 用 任何 单独 的 校正 机 制 。 这 些 误差 除了 
通常 的 均值 和 相位 偏 黎 ， 还 包括 波形 畸变 误差 。 


6.2.2 构建 一 个 查 表 


插值 前 ， 重 要 的 是 要 根据 6.1 节 的 内 容 纠正 来 自 编码 器 信号 的 误差 ， 虽 然 
sinna 和 cosna, AL MAF (6.3) 计算 ， 但 在 要 求 高 速 处 理 编码 器 信和 号 时 ， 公式 
计算 就 太 没 效 率 了 ， 特 别 是 在 n 很 大 的 时 候 。 查 表 可 以 设计 得 具有 高 效 处 理 的 能 
力 。 如 果 输 入 T, = sina 和 Z, = cosa， 这 个 表 可 直接 输出 sinna 和 cosna 的 值 。 

1. MAF i, 的 查找 表 

为 了 简化 的 推论 过 程 ，sinna 和 cosna 的 值 可 预先 计算 并 记录 ， 相 对 应 于 任 
一 去 ;和 到 ;预先 确定 的 样本 ， 以 及 它们 的 符号 (为 了 说 明 ， 立 ; 和 z, 的 符号 
将 用 于 此 目的 ) 。 为 了 简化 表格 的 处 理 ， 这 些 样本 在 -1 ~1 的 整个 幅度 范围 等 角 
索取 ， 而 不 是 在 超过 一 个 周期 的 整个 电气 角 范 围 内 索取 。 

例如 ， 考 虑 n=16 和 s =1024。 查 表 在 一 个 周期 内 相应 的 设置 如 表 6. 2 
所 示 。 
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表 6.2 NEF U, HERR 


















-l, =, - (s-1)/s, -1/s 


0.649, +, 


ui 


sinl6a | 0.016, ---, -0.649, 0.000 












-0.016, 0.0 












cosl6a 0.760, ---, 0.999, 1.0 

给 定 7, 的 实时 值 和 ©, 的 符号 ， 相 关 的 表 项 可 直接 定位 ， 因 为 采样 间隔 是 
固定 和 已 知 的 。 表 6. 3 作为 搜索 的 表 ， 引 在 有 效 地 找到 相关 和 条目。 索引 人 ，N.， 
Ny 首先 定义 为 


N, =round(s x Ñ) 


N =Ñ, (6.4) 
Na =s 
这 种 制 表 方 法 的 一 个 潜在 的 问 10 
0.9 


题 出 现 ， 由 于 机 电 角 qq， 六 | 的 振幅 ost + ina ~- 

具有 大 的 非 线 性 变化 。 使 用 预先 录 “| 二 

制 的 样本 Z,, MERRIE, Hee BOT 

味 着 相对 时 间 有 一 个 不 同 的 角度 间 83 P+ 

隔 ， 如 图 6. 1 所 示 。 Ob rt bebe pin | 
PASTE ARG BEET, = 12O ET Bama 7 

sina 守 1]。 因 此 ,为 了 这 个 信号 记录 图 6.1 角 振幅 的 变化 

的 部 分 有 足够 的 信息 ，* 必须 是 非常 

大 ， 这 相应 意味 着 一 个 大 的 查 表 。 图 6. 2 所 示 为 当 * = 5000 Al n = 64 时 的 插值 结 

果 。sin64a 和 cos64a 的 波形 在 sina=1 周围 失真 。 

















. L 1 
1.3 1.4 1.5 1.6 17 1.8 1.9 2 
采样 位 置 


图 6.2 基于 ;的 插值 
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6.3 索引 表 


























条 件 
N,>0 BLN, >0 N, 0 -mm2 > 
N,>0 HN, <0 2N; -N, T/2~T a, 
N, <0 BN, >0 | 3No +N, 30/2 ~ 2a z, 
N,<0 BN, <0 x 





2. 基于 7,0 7, HERR 
为 了 克服 这 一 困难 ， 并 | = sinna 和 立 , = cosna 的 两 振幅 可 预先 录制 ， 因 为 靠 


近 sina~1 区 域 ， 幅 度 和 相位 角 之 间 区 ,= cosa 有 一 个 更 均匀 的 关系 。 因 此 ， 六 ， 
用 于 推断 程序 更 加 有 效 ， 而 不 是 使 用 这 些 sina=1 附近 的 区 域 。 为 此 ， 一 个 方法 


Æl @,1 <0.707， 立 , 将 作为 基础 用 于 搜索 的 表 项 。 AM, 7, 的 振幅 用 于 代 


替 立 |。 从 本 质 上 讲 ， 这 意味 着 查找 表现 在 对 应 立 , 和 立 , 的 变化 由 多 部 分 组 成 。 
n =16 查找 表 如 表 6.4 所 示 。 


表 6.4 基于 U, Ma, HERR 




















为 方便 有 效 和 快速 地 访问 的 查 表 的 适当 部 分 ， 索 引 表 (类 似 于 表 6. 3) 是 有 
用 的 。 为 此 ， 索 引 N,，N.，N 定义 为 


N, = round( ziz * i] 
_ s ~ (6.5) 
N, = round( azy x i] 
N, =round(s x sin( 1/4) ) 
根据 这 些 索 引 ， 表 6. 5 给 出 的 实际 的 点 可 直接 定位 适当 的 sinna 和 cosna (n 
索引 ) ， 分 别 对 应 u, Mu, 的 各 部 分 。 
表 6.5 索引 表 


条 件 Windex a 用 万 或 2, 

















1 
N,>N HN, >0 2No -N, T/A ~ 1/2 z, 
N, >No AN, <0 2N +N, T/2 -3m/4 7 

u 


N< -M HN,>0 | 6N, - N, 50/4 ~3m/2 
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条 Ot 
N,<-N HN, <0 





a 用 u 1 Ru, 
39/2 ~77/4 



















N. >No LN, >0 O~ 1/4 


N,>Ny HN, <0 

















图 6.3 所 示 为 s=707 AN = 64 的 插值 结果 。 即 使 * =707， 也 没有 任何 波形 
畸变 ， 这 上 比 在 图 6. 1 所 用 的 小 (图 6.1 中 s=5000)。 


N 
NN, 


AA 









图 6.3 基于 z, 和 7, 的 插值 


3. 最 大 插值 

实现 的 最 高 插值 n’ 受 限于 在 一 个 周期 内 原始 编码 器 正弦 信号 记录 样本 的 最 
低 数 目 ， 也 受 限 于 一 个 周期 内 出 现 的 高 阶 正弦 信号 所 需 样品 的 最 低 数 目 ， 根 据 下 
列 公式 可 获得 n 的 数值 


n =— (6.6) 


Ep, s 是 在 一 个 sina 周期 内 所 录 得 的 最 低 样本 数 ，s, 是 出 现 了 一 个 sina 周期 
内 的 最 低 样 本 数量 。 例 如 ， 如 果 s =6， 并 需要 插值 1024 (Bl n* =1024)， 则 
s, =1536 ， 也 就 是 说 ， 在 一 个 原 信 号 周期 内 至 少 需要 得 到 1536 MEA, 

4. 波形 畸变 

海德 曼 方法 假设 从 编码 器 得 到 的 信号 为 周期 正弦 信号 且 无 波形 失真 。 实 际 
上 ， 实 际 编码 器 信号 的 波形 偏离 了 理想 的 正弦 波 波形 。 因 此 ， 在 假设 理想 正弦 波 
波形 基础 上 的 修正 可 能 会 产生 不 准确 的 位 置信 息 ， 这 对 高 精度 的 应 用 要 求 是 不 可 
以 接受 的 。 更 合理 的 假定 是 编码 器 信号 为 周期 性 的 和 重 现 性 好 的 波形 ， 不 一 定 是 
正弦 波 。 本 案 中 ， 由 于 非 正 弦 波 可 用 ， 可 以 采用 误差 映射 方法 ， 映 射 非 正 弦 波 误 
差 到 正弦 波 的 误差 ， 如 图 6. 4 中 所 示 。6. 2. 2 节 的 查 表 继 续 适用 。 
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_10 ; i i i 
-1.5 -1.25 -1 -0.75-0.5-0.25 0 025 0.5 0.75 1 1.25 15 


图 6.4 波形 误差 映射 


5. 转换 为 二 进 制 脉冲 

为 使 编码 器 的 信和 号 便于 由 通用 增 量 编码 器 接口 接收 ， 正 交 正 弦 信 号 必须 转换 
为 二 进 制 脉冲 序列 。 一 个 模拟 比较 器 可 用 来 将 高 阶 正弦 信号 转化 为 脉冲 信号 ， 如 
图 6. 5 所 示 。 相 关 的 正弦 信号 过 零 时 ， 比 较 器 将 简化 开关 脉冲 信号 。 该 模拟 信息 


的 其 余部 分 都 不 会 被 使 用 。 





图 6.5 正 交 正弦 信号 解码 


另外 ， 这 种 转化 可 以 更 有 效 地 在 查找 内 表 完 成 。sinna 和 cosna 表 项 可 以 直 
接 转 换 成 二 进 制 值 (分 别 4 AB) 根据 下 面 的 公式 


1 i 26 
4={ 当 sinna (6.7) 
-1 当 sinas -ô 
1 当 cosna>6 
B= 6.8 
E 当 cosnax -6 ( ) 


因此 ，4 和 B 可 以 是 正 交 方形 曲线 ， 直 接 从 表 6.4 产生 。 根据 测量 噪声 的 门限 ，5 
可 以 是 0 或 一 个 小 数值 集合 。 
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6. 直接 转换 为 位 置 数字 

表 6. 4 中 的 脉冲 信息 可 以 很 容易 地 转换 成 数字 位 置 值 ， 可 为 控制 的 目的 直接 
使 用 ， 而 无 需 再 计算 。 这 一 点 尤其 可 以 把 上 述 插值 方法 集成 到 一 个 普通 的 数字 控 
制 器 中 来 实现 。 另 外 ，PC 总 线 和 一 般 运动 控制 器 中 可 以 使 用 该 编码 器 卡 ， 可 以 
直接 从 寄存 器 或 共享 内 存 中 获取 数字 位 置 值 。 在 这 种 情况 下 ， 不 必 为 编码 器 卡 使 
用 D/A 转换 器 。 


6.2.3 试验 


采用 具有 高 速 A/D 卡 的 dSPACE 控制 器 并 使 用 海 登 海 因 线性 编码 器 LIP481 
获取 原始 正 交 正 弦 信 号 来 进行 预 播 值 信 号 调理 。 这 种 补偿 参数 为 : m; = 0. 0126， 
m, =1.4483e -004, A, = 0. 1331, A, = 0. 1221。 随 后 基于 增强 的 方法 进行 了 播 
值 。 图 6. 6 所 示 为 n=4 的 插值 结果 。 图 6. 7 所 示 为 n=16 的 插值 结果 。 














L l 1 
0 0.01 0.02 0.03 0.04 0.05 
采样 位 置 














一 上 i 4 -上 
0 0.005 0.01 0.015 0.02 0.025 
采样 时 间 
图 6.7 插值 结果 (n = 16) 


图 6. 8 所 示 为 n=16 的 插值 结果 ， 此 外 ， 其 中 的 查 表 项 转换 为 二 进 制 值 直接 
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产生 二 进 制 脉冲 。 为 了 使 脉冲 〈 类 似 的 振幅 ) 更 清楚 地 显示 在 图 6.8 H, BRIR 
幅 是 故意 设置 为 0.8。 图 6. 9 所 示 为 n =32 的 插值 结果 。 




















5 1 L 1 一 L 1 
0.018 0.02 0.022 0.024 0.026 0.028 0.03 
采样 时 间 


图 6.8 转换 正 交 插值 与 脉冲 (n=16) 








1.5 
Lob e œ m m cn om mma ma 
` = 

O.5- 
mw | A ii 
媒 

iy 
-1.0 F 
1 











dos 002 0022 0024 0026 0028 003 
采样 时 间 
图 6.9 播 值 和 正 交 脉 冲 转换 (n =32) 
为 了 更 清楚 地 说 明 非 正弦 编码 器 信号 和 使 用 映射 校正 的 情况 ， 三 角 波 被 模拟 
和 了 映射 到 正弦 信号 。m” = 8 的 插值 结果 及 其 李 萨 如 图 形 如 图 6. 10 所 示 。 








图 6. 10 ”映射 的 播 值 结 果 及 其 李 萨 如 图 形 (n=8) 
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6.3 插值 的 参数 模型 


用 查 表 插值 可 以 提高 编码 器 的 分 辨 率 。 但 是 ， 这 种 方法 会 导致 类 似 在 第 5 章 
介绍 的 几何 补偿 查 表 方 法 的 缺点 。 径 向 基 函 数 (RBF) 神经 网 络 可 以 任意 平稳 良 
好 地 逼近 任意 非 线性 函数 。 在 只 有 输入 /输出 对 可 用 和 明确 的 关系 是 未 知 时 ， 这 
些 函 数 特别 有 用 。 根 据 现 有 的 正弦 信 叶 ， 有 效 的 插值 可 以 看 做 是 一 个 可 用 数据 的 
处 理 过 程 。 径 向 基 函 数 神经 网 络 的 训练 需要 在 多 维 空间 中 寻找 最 适合 可 用 数据 的 
平面 。 本 节 将 介绍 如 何在 提出 各 种 可 能 的 结构 中 ， 实 现 最 简单 的 径 向 基 冰 数 结 
构 ， 最 大 限度 地 减少 了 充分 适应 映射 过 程 中 的 数据 元 余 。 

简化 径 向 基 函 数 网 络 分 两 个 阶段 。 第 一 阶段 主要 是 有 关 输 入 的 编码 器 非 理想 
信号 的 径 向 基 函 数 修正 ， 包 括 均值 、 相 位 偏 移 、 振 幅 和 波形 畏 变 的 偏差 补偿 。 径 
向 基 函 数 神经 网 络 可 以 在 线 自 适应 更 新 ， 以 反映 任何 编码 器 的 信号 后 续 变 化 或 漂 
移 的 特性 。 第 二 阶段 则 在 从 第 一 阶段 信号 校正 的 基础 上 导出 高 阶 正弦 信号 ， 将 一 
系列 高 频 二 进 制 脉冲 进行 转换 ， 进 而 可 以 很 容易 地 由 标准 伺服 控制 器 进行 解码 。 
本 节 中 介绍 了 限制 和 影响 插值 精度 的 因素 ， 并 给 出 了 试验 结果 ， 描 述 了 实际 应 用 
的 原理 和 开发 方法 。 


6.3.1 插值 方法 的 原理 


径 向 基 函 数 网 络 整体 配置 的 两 个 阶段 (为 编码 器 插 补 ) 如 图 6.11 所 示 。 两 
个 阶段 由 预 补偿 阶段 和 插值 阶段 组 成 。 预 补偿 阶段 的 输入 是 来 自 于 编码 器 x 和 
u 的 正 交 信 和 号 阶段 ， 预 补偿 的 输出 作为 直接 送 到 插值 阶段 的 输入 。 插 值 阶段 的 
输出 是 更 高 阶 的 正弦 波 ，sinna 和 cosna (HP n 称 为 插值 的 阶 ) 。 


Tm 








gara 
i 
ay ARB , 
: oo 1 
© 


Adaption 
Algorithm 
























i | | 
预 补偿 阶段 的 RBF 网 络 插值 阶段 的 RBF 网 络 
图 6.11 径 向 基 函 数 网 络 整体 配置 的 两 个 阶段 
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两 个 阶段 都 使 用 了 一 个 两 层 径 向 基 消 数 网 络 配 置 。 预 补偿 阶段 校正 了 编码 器 
原始 信号 的 误差 。 改 进 校正 过 程 采用 了 一 种 适应 算法 ， 因 为 原始 信号 的 误差 特性 
表现 出 一 种 从 时 间 到 时 间 漂 移 的 倾向 。 每 当 信号 有 M 个 时 间 的 新 一 批 样本 可 以 
利用 时 ， 在 线 批 处 理 更 新 过 程 对 第 一 阶段 〈( 预 补偿 阶段 〉 的 径 向 基 码 数 进行 更 
新 。 更 新 过 程 基于 改进 的 递 推 最 小 二 乘 算法 (Ljung 1997 年 )。 基 于 从 前 面 的 预 
补偿 阶段 来 的 校正 信号 ， 插 值 阶段 推导 出 了 高 阶 正弦 波 。 

对 于 这 两 个 阶段 ， 目 标 可 概括 如 下 。 

给 定 一 个 p 维 输 入 空间 中 具有 NN 个 不 同 的 点 的 集合 (Br eR, k=l, 
2，…,N) 和 一 个 4 维 空间 中 相应 严 个 输出 点 的 集合 ，( 即 4 eR, k=1, 2, 
…， 殉 ) 。 必 须 找到 一 个 映射 函数 : 3RR 完成 这 个 关系 ， 使 得 (x*) =a", 
k= 1，2，…，N。 对 于 预 补偿 阶段 ， 映 射 函数 将 映射 编码 器 原始 的 信号 (uw ， 
u) 到 校正 信号 (wl ，ws)， 从 而 成 为 插值 阶段 的 输入 。 对 于 插值 阶段 ， 映 射 函 
数 将 实现 从 u, u HANEKE r. r 的 映射 。 

首先 定义 随后 描述 中 会 出 现 的 符号 如 下 ， 相 对 应 的 第 天 帧 〈 批 ) 的 数据 i= 
1，2，…，HMiJ = 1，2: 

ei(k) =d; -u;(k) 


M i72 k 


uj(k) = F w, (kb, (uj (k)) 

i | wie) -c;(k) I? 
bP) se| "Dr | 

W(Ek) =[w, (k) w, (k)--wy (k) 1" 

Dik) =[bi,(uj(k)) pa Cuk) ) pn Cak)" 


6.3.2 预 补偿 阶段 


编码 器 信号 中 常见 的 误差 包括 均值 、 相 位 偏 移 、 振 幅 偏差 和 波形 畸变 。 为 了 
减少 插值 的 误差 ， 插 值 之 前 ， 必 须 校正 这 些 误差 。 图 6. 11 显示 了 如 何 将 这 些 误 
差 部 分 使 用 预 补偿 阶段 的 自 适 应 径 向 基 函 数 网 络 的 方式 予以 解决 。 如 前 所 述 ， 为 
了 这 个 目的 ， 自 适应 方法 是 有 用 的 ， 因 为 编码 器 原始 信号 的 误差 特性 可 能 随时 间 
漂移 。 

理想 情况 下 ， 正 交 编 码 器 信号 (分 别 记 为 u Alu.) 是 同样 的 正弦 信号 ， 相 
HA w/2 相位 差 

u, = Acosa u, = Asina 


HY, a 为 瞬时 相位 ，4 表示 该 信号 的 振幅 。 如 果 没 有 波形 畸变 ， 有 关 理想 与 实 
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际 编码 器 信号 的 通用 方程 ， 可 根据 海 登 海 因 (Heydermann) 于 1981 年 的 研究 得 到 
-= am - _Acos(a-e) 
1 =U, 1 25 G 
HF, m 和 ms 是 信和 号 的 平均 值 ，e E. u Mu, 是 从 编码 器 获得 的 值 。G = 
A,/A,, HLA, AIA, 是 编码 器 信号 的 实际 幅度 。 偏 移 量 参数 mm Am, e 和 C 可 使 
用 最 小 二 乘 估计 方法 对 原始 信和 号 操作 进行 估计 。 

使 用 两 层 径 向 基 消 数 网 络 ， 这 种 校正 可 以 很 容易 地 从 原始 信号 映射 到 理想 的 
信号 完成 。 此 外 ， 不 同 于 海德 曼 方法 ， 波 形 畸 变 可 用 映射 函数 直接 解决 。 为 了 使 
预 补偿 阶段 的 径 向 基 函 数 网 络 在 其 误差 特征 可 能 变化 期 间 进 行 参 数 自 适 应 微调 ， 
需要 一 个 自 适 应 算法 。 这 里 使 用 的 自 适 应 算法 是 递 推 最 小 二 乘 算法 (Ljung 1997 
年 ) 修改 后 的 版 本 。 径 向 基 函 数 网 络 的 参数 都 在 李 雅 普 诺 夫 意 义 上 更 新 ， 以 使 
AX (6.9) 的 误差 可 渐 近 收敛 到 零 。 下 面 的 算法 是 用 来 更 新 径 向 基 函 数 网 络 的 
参数 〈 算 法 中 只 有 说 明了 径 向 基 函 数 网 络 的 权 值 调整 ， 径 向 基 函 数 网 络 的 其 他 
参数 的 调整 是 类 似 的 ， 例 如 中 心 值 )。 

W,(k) =W,(k-1) +8:(k)AI(E) 


+m, 


其 中 





i(k) [i sD) 


8) = ey ett? AE)! 


(6.9) 


和 0<p<1， 
Ai(k) =d -W)(k-1) @i(k) 
其 中 , i=l, 2, =, M; j=1, 2o 
下 面 验证 该 算法 的 收敛 性 。 假 设 选择 李 雅 普 诺 夫 能 量 函 数 为 Y(k) =E (k) 

因此 
AV(k) =V(k) -V(k-1) 

=E,(k) —E,(k-1) 

E” fe?) 


= SE - (k= 1) 


x 


(di - ui(k))? - E(k -1) 


(di ~ W (k) Bi(k) )? - E(k- 1) 


= Ms i 


(di — (Wi(k -1) + Ai CD (k)) @i(k))? - E(k -1) 


i= 


(di - Wi(k -1)@i(k) -ACE (k) D; (k))? - E(k-1) 


IMa 
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© (AH) = AP E (E) DiC)? -EC = 1) 


1 
M 
= HD, AG -oD )) = E(k = 1) (6.10) 
将 方程 (6.9) 代入 方程 (6.10) 


_1&/ elk-1) E 
AV(k) po pi) - E(k -1) 


-U -p ]E;(k-1) <0 


因此 ， 在 李 雅 普 诺 夫 稳 定性 理论 ,方程 (6.9) 的 逼近 误差 是 稳定 的 ， 并 且 
将 收敛 在 半径 r 的 超 球 内 (7 是 一 个 较 小 的 值 ) 。 图 6. 12 所 示 为 径 向 基 硝 数 网 络 
预 补偿 阶段 前 后 的 基本 编码 器 信号 。 基 本 原始 信号 的 各 种 误差 组 成 部 分 在 这 个 阶 
段 后 会 得 到 校正 。 随 后 的 插值 阶段 将 只 处 理 理想 的 正弦 信号 。 


AM A 
i 


让 i ji i 


45 55 x03 
图 6.12 fsa Ree AME BAT Ss EA eS BS 

















6.3.3 插值 阶段 


插值 阶段 的 输入 是 来 自 于 预 补偿 阶段 的 u, 和 wu,。 从 插值 阶段 输出 的 是 高 阶 
正弦 波 的 瞬时 值 ， 即 r, 和 r+。( 输 出 依赖 于 插值 的 阶 )。 利 用 径 向 基 薄 数 网 络 来 
实现 这 种 映射 。 该 网 络 进行 离线 训练 ， 其 中 径 向 基 函 数 网 络 的 权 值 (ws ) 和 中 
心 值 (ca) 是 进行 调整 的 自由 参数 。 随 着 插值 阶 数 的 增加 ， 网 络 的 内 存 需求 也 
相应 增加 ， 因 为 映射 函数 3(. ) 将 变 得 更 加 复杂 。 因 此 ， 更 多 的 计算 单元 (h) 
(和 后 来 的 权 值 凤 要 进行 调整 ) ， 以 实现 揪 值 。 

为 了 减少 这 种 径 向 基 函 数 网 络 单个 阶段 的 内 存 要 求 ， 尽 量 减 少 径 向 基 范 数 网 
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络 内 的 宛 余 水 平 是 有 用 的 。 为 此 ， 值 得 注意 的 是 纯正 弦 波 有 很 强 的 对 称 度 。 只 考 
虑 一 个 完整 正弦 波 的 四 分 之 一 周期 ， 输 入 的 绝对 值 Clu, 1 和 1 w,1 ) 与 高 阶 正 
弦 波 输出 的 绝对 值 (7, 和 7,) 之 间 映 射 函 数 S(. ) 可 充分 反映 完整 信号 的 输出 。 
高 阶 正弦 波 Cr, Mr) 的 符号 可 根据 表 6. 6 推断 恢复 u, Alu, 的 符号 。 

有 许多 不 同 的 方法 来 调整 径 向 基 函 数 网 络 的 参数 。 它 们 包括 “固定 中 心 随 
机 选 定 ”"、“ 自 组 织 选择 中 心 值 ” 和 “监督 选择 中 心 值 ” 方 法 。 读 者 可 参考 海 金 
( Haykin) 1994 年 对 于 可 校正 技术 的 更 详细 的 介绍 。 
































表 6.6 调度 表 
uj (k) uj (k) 范 输 出 
; — ri (k) . 

uw (k) 20 — u,(k) 20 O~ 1/2 kh) 
— ri (k) 

— ui (k) <0 /2 ~ . 
í us 一 =k) 
一 -ri(k) 

ui (k) <0 一 u,(k) 20 30/2 ~27 . 
— 73(k) 
; 一 -ri(k) 

— ui k 0 ~3 /2 

uz (k) < T~3T =A) 


在 本 节 中 ,使 用 “监督 选择 中 心 值 ”方法 (Haykin 1994 年 ) ， 其 中 的 参数 
在 接受 监督 学 习 过 程 中 进行 调节 ， 采 用 纠 错 学 习 〈 即 梯度 下 降 过 程 ) 。 监 督学 习 


进程 的 主要 目标 是 为 尽量 减少 成 本 函数 吉 = Linet, JEP, k ERRE, 


用 于 调整 参数 值 ; es 是 误差 的 信号 (VIBE AE i AE R A fh E E] 
的 ) ， 定 义 为 
e = 太一 人 (xi ) (6. 10) 
Ed, Fx, (k=1, ++, K) 分 别 是 理想 的 输出 和 训练 数据 ， 并 且 X(. ) 是 由 
径 向 基 函 数 网 络 建 模 的 函数 。 所 需 的 输出 值 & 和 di 分 别 从 理想 的 正弦 和 余弦 数 
学 函数 的 振幅 获得 。 


6.3.4 试验 研究 


在 本 节 中 ， 真 实 的 试验 结果 说 明了 在 线 自 适应 校正 及 插值 方法 的 有 效 性 。 在 
试验 中 ， 原 始 数 据 是 由 一 个 线性 编码 器 ( 型 号 为 Heiden-hein LIP481A) 连接 到 
一 个 线性 电动 机 滑 片 上 获得 的 。 这 些 原始 信号 输入 到 一 个 具有 高 速 A/D 卡 的 
dSPACE 控制 器 ， 其 基于 径 向 基 函 数 算法 不 被 实现 。 相 应 的 原始 信号 进行 预 补 
偿 ， 插 值 到 高 阶 正弦 波 。 图 6. 13 和 图 6. 14 分 别 为 上 =64 Al n = 4096 的 插值 结 
果 。 图 6. 15 所 示 为 编码 器 插值 信号 转换 为 具有 =4096 的 脉冲 信号 。 脉 冲 被 缩 
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采样 时 间 /s 
图 6. 15 转换 为 脉冲 的 编码 器 信号 (n=4096) 


值 阶段 径 向 基 范 数 网 络 的 数据 点 的 数目 是 径 向 基 沙 数 网 络 权 值 所 规定 的 数目 。 在 
试验 研究 中 ， 一 个 完整 的 正弦 或 余弦 函数 映射 消除 元 余 时 ， 只 要 求 有 7 点 ， 如 图 
6. 16 所 示 。 对 径 向 基 函 数 方法 n = 16308 个 数据 点 是 必要 的 ， 而 查 表 方 法 是 
12 288 个 数据 点 。 随 着 存储 空间 需求 的 减少 ， 径 向 基 函 数 方法 执行 速度 也 随 之 大 
大 提高 。 


























0.8 0.8 
0.6 0.6 
0.4 0.4 
i 0.24 0.2 
IR 
g 0 车 0 
i EO 
—0.2 + œ -0.2 
-0.4 } -0.4 
—0.6 | 一 0.6 
-0.8 一 0.8 
一 ] 1 4 一 1 1 1 
0 2 4 6 0 2 4 6 
采样 时 间 /s 。 x10-4 采样 时 间 /s X10 1 


图 6.16 径 向 基 消 数 方法 正 驼 和 余弦 函数 模型 所 需 的 数据 数目 
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产生 机 器 和 机 械 设备 的 振动 的 因素 有 许多 ， 如 不 平衡 的 惯性 ， 涡 轮机 、 电 动 
机 、 发 电机 、 泵 、 驱 动 器 、 涡 轮 风扇 发 动机 等 的 轴承 故障 ， 运 动 学 设计 差 导 致 非 
刚性 支撑 结构 ， 部 件 故 障 和 额定 载荷 规定 外 的 操作 。 本 机 振动 信号 通常 可 以 描述 
为 一 个 从 1Hz ~500kHz 范围 内 的 窗 带 干扰 信号 。 为 了 防止 振动 时 发 生 严重 故障 
或 机 器 振动 在 共振 频率 使 设备 损坏 ， 实 时 监测 和 控制 装置 是 非常 有 用 的 。 当 机 械 
被 用 来 实现 高 度 精 确 的 定位 功能 时 ， 不 必要 的 振动 可 导致 性 能 重复 性 差 ， 阻 碍 任 
何 系统 误差 补偿 的 努力 。 这 将 导致 精度 和 准确 性 的 直接 损失 。 

本 章 提供 了 三 种 可 能 的 方法 来 处 理 机 械 振动 。 第 一 种 方法 将 集中 于 一 个 适当 
的 机 械 设 计 ， 在 确定 机 械 结 构 的 基础 上 把 机 械 振 动 减少 到 最 低 限 度 。 虽 然 系 统 设计 
方法 是 机 械 系 统 尽量 减少 振动 的 第 一 个 关键 步 又 ， 用 平行 监测 和 抑制 机 构 应 对 在 操 
作 过 程 中 振动 的 渗透 和 一 般 不 可 预测 的 额外 振动 源 ， 也 是 非常 必要 的 。 第 二 种 方法 
利用 了 一 种 自 适应 陷 波 器 来 确定 共振 频率 ， 并 随后 阻止 限 频 以 外 的 频率 信号 通过 一 
个 窗 带 阻尼 滤波 器 。 这 种 自 适 应 陷 波 器 可 以 直接 纳 人 控制 系统 。 第 三 种 方法 可 使 用 
实时 分 析 仪 来 检测 过 多 的 振动 ， 该 方案 可 以 独立 于 控制 系统 实现 ， 因 此 应 用 时 无 
需 修改 现 有 的 设备 。 使 用 连接 到 机 器 上 的 加 速度 计 在 正常 运行 条 件 下 从 振动 信号 
提取 振动 特征 。 然 后 ， 用 模式 识别 模板 进行 特征 与 实时 振动 信号 的 比较 。 当 比较 
结果 超出 了 可 接受 的 阐 值 时 ， 和 警报 被 激活 。 在 造成 机 器 损坏 之 前 可 以 进行 纠正 。 


7.1 机 械 设计 中 尽量 减少 振动 


在 高 速 、 高 精密 运动 系统 发 展 过 程 中 ， 决 定论 的 概念 是 由 埃 文 《1989 年 ) 提 
出 的 一 个 关键 的 想法 ， 即 一 个 物理 系统 应 符合 因果 规律 ， 其 特性 允许 建立 物理 系统 
的 数学 模型 。 描 述 模型 的 主要 方程 可 以 用 来 预测 系统 的 特性 ， 从 而 可 以 补偿 误差 ， 
满足 严格 的 误差 设计 要 求 。 机 电 一 体 化 的 方法 是 各 种 机 械 设计 中 的 一 条 可 能 的 路 
径 ， 它 要 求 结构 设计 和 控制 设计 无 颖 集成 。 这 种 方法 已 被 许多 科学 家 和 工程 师 所 采 
用 ， 它 的 好 处 是 明显 的 ， 并 且 已 经 有 了 最 终 产 品 ， 如 菏 片 扫描 器 和 圆 片 分 档 器 。 

在 本 节 中 ， 解 决 问 题 的 关键 是 要 进行 一 个 健全 的 机 械 设 计 ， 设计 最 突出 的 特 
点 是 机 械 振动 保持 在 最 低 限度 。 精 密 运 动 系统 的 机 械 设计 间 题 涉及 非常 大 的 领域 。 
在 本 节 中 ， 唯 一 关键 的 是 突出 表现 在 一 般 情 况 下 设计 人 员 在 初始 阶段 ， 甚 至 在 物理 
建 模 阶 段 ， 要 设计 “精确 的 ”结构 。 设 计 是 一 个 迭代 的 过 程 ， 始 终 要 求 设 计 人 员 
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频繁 访问 图 板 ， 直 到 实现 优化 设计 。 本 节 将 给 出 定性 的 观念 并 用 丰富 的 数字 来 说 明 
这 一 关键 点 ， 而 不 是 使 用 一 个 纯粹 的 定量 方法 ， 原 因 是 在 设计 的 最 初 阶 段 ， 通 常 决 
策 时 密集 的 量化 是 不 必要 的 。 大 量 的 迭代 和 数学 优化 应 在 设计 过 程 的 下 一 阶段 进行 。 


7.1.1 机 械 结 构 的 稳定 性 和 静 定 性 


结构 是 一 个 供给 所 有 配件 构成 机 器 的 支撑 框架 ， 也 可 以 是 许多 规模 更 小 的 结 
构 集 合 ， 有 时 也 可 能 是 一 个 单一 的 组 件 集合 。 高 速 运动 部 件 的 反作用 力 将 激发 结 
构 产 生机 械 振动 。 这 些 振 动 既 可 以 通过 减少 激励 ， 也 可 以 通过 减少 受 激 结构 的 响 
应 ， 加 以 抑制 (比尔 兹 ，1983 年 ) 。 第 一 个 成 因 可 以 通过 在 结构 范围 内 ， 重 新 配 
置 振动 源 或 隔离 振动 源 来 加 以 克服 ， 使 产生 的 结构 振动 不 会 传 给 支撑 它 的 结构 。 
至 于 第 二 个 成 因 ， 可 以 改变 质量 、 刚 度 或 阻尼 来 改变 结构 的 响应 。 为 了 了 解 该 结 
构 的 动态 响应 ， 真 实 的 结构 可 以 转变 为 物理 模型 ， 通 常 将 真实 的 结构 简化 为 模 
型 ， 例 如 ， 真 实 的 机 器 可 以 建 模 为 一 个 由 许多 弹簧 -质量 耦合 的 系统 。 一 个 由 真 
实 系统 派生 的 物理 模型 ， 它 可 以 表示 成 为 一 个 数学 模型 ， 通 过 软件 或 手工 计算 来 
求解 ， 从 而 使 不 同学 科 的 工程 师 能 够 沟通 和 改善 其 设计 的 各 个 部 分 。 

每 一 个 建立 机 械 结构 的 设计 师 都 需要 回答 一 个 很 重要 的 问题 : 所 设计 的 结构 
是 刚性 的 和 牢固 的 吗 ? 如 果 一 个 结构 是 刚性 的 ， 没 有 结构 成 员 的 变形 会 导致 它 的 
形状 产生 改变 〈 弗 菜 明 ，1997 年 ) ， 而 且 如 果 刚 体 的 移 位 或 转动 不 发 生 ， 结 构 是 
稳定 的 。 判 断 一 个 结构 稳定 与 否 的 一 个 好 办 法 是 判断 不 定性 的 程度 。 如 果 所 有 的 
反作用 力 和 支撑 各 成 员 内 部 的 力 只 由 静 力 平衡 方程 决定 ， 所 考虑 的 结构 是 一 个 静 
定 结构 。 否 则 ， 被 认为 是 超 静 定 结构 。 出 现 超 静 定 结构 是 由 于 出 现 了 额外 的 支 
撑 、 部 件 、 反 作用 力 及 反作用 力矩 。 对 于 一 个 要 求 静 定 的 结构 ， 首 先 必 须 正确 地 
构建 ， 然 后 必须 正确 地 支撑 。 


7.1.2 二 维 结构 


实际 中 的 大 多 数 机 械 结 构 是 三 维 的 。 然 而 ， 在 推广 为 一 个 三 维 的 问题 之 前 ， 
不 妨 首 先 看 看 两 维 问题 。 一 般 来 说 ， 机 械 结构 是 固定 的 ， 因 此 力 和 力矩 的 作用 在 
它 上 面 的 总 和 必须 为 零 ， 根 据 牛 顿 第 二 定律 ， 数 学 形式 为 


YF, =0 (7.1) 
> F, =0 (7.2) 
> M, =0 (7.3) 


HR, F, ALF, 分 别 是 在 x Al y 轴 的 力 ，M. 是 关于 z 轴 的 力矩 ，z 轴 是 指向 
页 面 的 。 对 于 一 个 平面 结构 ， 可 以 利用 符号 约定 ， 如 图 7. 1 所 示 。 
因为 一 个 结构 静 定 性 是 一 种 双重 的 问题 ， 可 以 进行 处 理 ， 而 不 首先 考虑 支 
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撑 。 每 个 结构 配置 可 以 进行 测试 ， 以 验证 平 
面 结构 是 否 满 足 方程 
2j=m+3 (7.4) 
其 中 , j 表示 该 节点 数 ，m 表示 构件 数 ， 于 
是 有 三 种 可 能 的 情况 ， 即 
1) 如 果 妇 = 于 +3， 则 是 静 定 结构 。 
2) 如 果 2>m +3， 则 是 不 稳定 的 





3) WRZ <m+3, MERREM. 
这 三 个 条 件 在 图 7.2 中 得 以 描绘 。 
















/4 
m=4 
2>m+t3 





c) d) 
图 7.2 平面 结构 的 三 角形 
a) 静 定 结构 b) 静 定 结构 c) 不 稳定 结构 d) 超 静 定 结 构 


当 由 于 部 件数 不 足 、 结 构 不 稳定 时 ， 结 构 似 乎 成 为 一 个 四 杆 机 构 ， 并 具有 一 
个 自由 度 ， 如 图 7.2c 所 示 。 这 种 自由 的 程度 是 不 可 取 的 ， 因 为 需要 设计 的 是 机 
构 ， 而 不 是 机 械 。 然 而 ， 如 果 有 太 多 部 件 出 现 ， 就 成 为 超 静 定 结构 。 在 这 样 的 条 
件 下 ， 如 果 第 五 个 杆 尺寸 不 准确 ， 在 如 图 7. 2d 所 示 结 构 的 第 五 杆 将 很 难 装 配 。 
即使 没有 任何 外 部 载荷 ， 装 配 也 很 有 可 能 会 有 误 力 与 内 部 压力 存在 于 结构 之 中 。 
当 没 有 加 载 自身 的 重量 以 外 的 其 他 外 部 载荷 时 ， 静 定 结构 是 无 压力 的 。 由 于 气温 
上 上 升 其 构件 发 生 膨胀 ， 静 定 结构 允许 其 构件 热膨胀 ， 但 没有 引发 来 自 多 余 的 构件 
造成 的 过 度 约束 条 件 的 任何 压力 。 

平面 结构 的 三 角形 是 一 个 基本 的 形态 ， 如 图 7.2 所 示 。 静 定 平面 结构 可 以 由 
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这 个 简单 的 基本 结构 扩大 为 每 一 个 新 加 入 贸 链 连接 两 个 新 构件 到 两 个 不 同 存在 的 
Bee, WAT. 2b 所 示 。 然 而 ， 这 两 个 新 构件 的 轴 不 能 形成 一 条 线 ， 换 句 话说 ， 
三 个 贸 链 不 能 在 同一 线 上 ， 如 图 7. 3a 所 示 。 还 应 当 记 住 ， 地 面 构成 一 个 构件 ， 
以 及 所 有 匀 链 是 引 脚 接头 ， 如 图 7. 3b 所 示 。 





图 7.3 不 稳定 结构 和 多 余 构件 
a) 不 稳定 结构 b) 多 余 构件 


结构 的 第 二 部 分 设计 是 它 的 支撑 。 从 这 个 角度 看 ， 整 个 结构 可 以 视 为 刚体 。 
对 于 一 个 平面 结构 ， 具 有 三 个 自由 度 ， 即 平面 结构 能 够 在 x My 方向 运动 ， 并 绕 
有 关 的 z 轴 旋转 。 因 此 ， 需 要 有 三 个 构件 提供 三 个 反作用 力 ， 来 完全 约束 平面 中 
的 平面 结构 。 图 7. 4a ~c 所 示 为 平面 结构 某 些 稳定 恰当 的 结束 支撑 ,而 图 7. 4d 
所 示 为 一 个 不 稳定 的 支撑 情况 。 


a) , b) 
Z o 3 | d | 
图 7.4 稳定 恰当 的 结束 支撑 和 不 稳定 的 支撑 情况 
a) 稳定 的 恰当 的 约束 支撑 b) 稳定 的 恰当 的 约束 支撑 c) 稳定 的 恰当 的 约束 支撑 d) 不 稳定 的 支撑 情况 


第 7 章 振动 监测 与 控制 153- 


应 当 指 出 ， 同 一 地 点 有 两 个 支撑 构件 可 以 被 一 个 引 脚 接头 取代 ， 如 图 7.5 所 
示 。 很 明显 ， 在 这 两 种 情况 下 ， 它 们 构成 了 两 个 反作用 力 ， 并 且 不 限制 平面 结构 
绕 z 轴 进 行 转动 。 


YW 
图 7.5 相当 于 两 个 构件 的 支撑 


为 了 结构 稳定 和 静 定 ， 结 构 及 支撑 必须 有 正确 的 构件 数目 。 这 时 必须 解决 所 
采用 的 结构 在 哪里 加 载荷 的 问题 。 为 此 ， 有 必要 审查 构成 结构 的 构件 。 该 连 杆 构 
件 的 刚度 受到 负载 轴 向 轴 的 应 用 ， 横 断面 几何 〈 如 圆 钢 的 直径 ) 和 弹性 模 量 ， 
以 及 它 的 材料 E 值 的 影响 。 在 大 多 数 情况 下 ， 连 杆 的 安装 既 有 拉 伸 压缩 ， 又 有 
弯曲 ， 如 表 7. 1 所 示 ， 其 所 对 应 三 种 受 力 情况 如 图 7. 6 所 示 。 


表 7.1 轴 向 载荷 与 弯曲 载荷 的 刚度 比较 








RO ty 刚 OE 标准 刚度 





a) 拉 伸 力 k, =0.25mEd/L 1 








b) 





压力 k, =0. 25aEd?/L 1 








k, =0. 7Sakd*/L 3(d/L)? 


注 : MERMA N/m, E KA N/m, dA LARA m, H Ld 


L L 0.5L F 
l a) b) c) 
图 7.6 连 杆 的 三 种 受 力 情况 


很 明显 通过 检查 表 7. 1， 一 个 连 杆 轴 向 载荷 的 刚度 远 远 好 于 弯曲 载荷 。 对 于 
d=0.05m, L=1.2m 的 值 ，k,/h 的 比值 是 192。 也 就 是 说 ， 一 个 轴 向 负载 的 连 
杆 与 弯曲 负载 相 比 具 有 192 倍 的 刚度 。 因 此 ， 在 设计 一 个 硬性 和 刚性 的 结构 ， 构 
件 中 必须 是 拉 伸 力 或 压力 载荷 ， 不 能 弯曲 。 有 时 重新 设计 一 个 外 部 载荷 应 用 到 结 
构 的 方法 ， 可 以 大 大 提高 结构 刚度 。 各 种 受 力 情况 如 图 7.7 所 示 ， 而 刚度 比较 如 
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表 7. 2 所 示 。 作 为 一 般 规则 来 观察 ， 加 载荷 点 应 位 于 匀 链 。 





图 7.7 各 种 受 力 情况 


表 7.2 各 种 载荷 配置 的 刚度 比较 























图 7.7 刚 Æ 标准 刚度 比 较 值 

a) k, =0. 25Ed?/L 1 1 

b) k, =0. 7SaEd*/L? 3(d/L)? 1/192 
T [一 

c) k, =0. SmEd? sin? B/L sin? 1/2 

d) ky =0.0477Ed /D3 0. 1875( d/L)? 1/3072 

e) k, =0.25mEd?/L 1 1 





7.1.3 三 维 结构 


下 面 考虑 空间 结构 或 三 维 结构 。 在 大 多 数 情况 下 应 用 的 都 是 这 些 结构 。 广 泛 
意义 上 空间 结构 可 以 看 做 是 许多 平面 结构 的 组 合 ， 排 列 的 方式 使 所 有 的 平面 不 共 
面 。 因 此 ， 对 于 刚性 的 空间 结构 ， 空 间 结构 中 每 一 个 平面 结构 必须 在 它 自己 的 平 
面 中 是 刚性 的 。 这 是 深入 理解 平面 结构 要 求 刚性 的 一 个 原因 。 

由 于 机 械 结构 是 固定 的 ， 根 据 牛 顿 第 二 定律 ， 力 和 力矩 的 作用 在 它 上 面 的 总 
和 必须 为 零 。 在 数学 上 这 意味 着 

> F =0 (7.5) 


ym =0 (7.6) 
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EF, 严 和 形 分 别 是 三 维 力 和 力矩 向 量 。 使 用 图 7. 1 中 的 约定 符号 。 
每 个 结构 配置 可 以 测试 验证 是 否 平面 结构 满足 方程 
37 =m+6 (7.7) 
其 中 , j RMBBERRA, m 表示 构件 数目 。 那 么 有 三 种 可 能 的 情况 ， 即 

1) 如 果 3j= 柬 +6， 则 结构 是 静 定 结构 。 

2) 如 果 31 > m +6， 则 结构 是 不 稳定 的 结构 。 

3) 如 果 37 <m+6， 则 结构 是 超 静 定 结构 。 

在 平面 结构 中 ， 基 本 形状 是 三 角形 ， 它 是 刚性 和 静 定 的 。 在 空间 结构 中 ， 
刚性 和 静 定 的 基本 形式 是 四 面体 ， 如 图 7. 8 所 示 。 在 三 角形 平面 结构 中 的 三 个 
现 有 匀 链 ， 添 加 一 个 新 的 非 共 面 擦 链 产 生 了 四 面体 结构 。 这 个 新 的 铵 链 与 三 个 
新 构件 一 起 连接 到 现 有 的 匀 链 上 。 遵 循 这 一 程序 ， 可 以 得 到 刚性 和 静 定 的 空间 
结构 。 


MBE 
3 个 新 构件 


平面 三 角 结 构 


图 7.8 基本 空间 结构 为 四 面体 


其 他 空间 结构 如 图 7. 9 和 图 7. 10 所 示 。 另 外 值得 注意 的 是 ， 各 构件 与 球 铵 
连接 。 





7.9 来 自 四 面体 结构 的 金字 塔 结构 
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图 7.10 来 自 四 面体 结构 的 箱 式 结构 


到 目前 为 止 ， 从 三 角形 平面 结构 获得 四 面体 空间 结构 ， 从 四 面体 结构 得 到 金 
字 塔 ， 以 及 从 四 面体 得 到 箱 式 结构 的 方法 已 经 进行 了 说 明 。 设 计 的 下 一 个 部 分 是 
将 这 些 结构 结合 起 来 。 该 结构 可 以 视 为 看 合 在 一 起 的 刚体 ， 并 且 在 空间 中 刚体 具 
有 6 个 自由 度 ， 即 结构 具有 %*、y 和 z 方 向 的 平移 的 能 力 ， 以 及 绕 x*、y Az 轴 旋 
转 的 能 力 。 因 此 ， 需 要 有 6 个 构件 提供 6 个 反作用 力 准 确 约 束 空间 结构 。 图 7. 11 
所 示 为 一 个 典型 的 龙门 空间 结构 ， 它 广泛 应 用 于 多 坐标 测量 仪 (CMM) 中 。 但 
是 ， 图 7. 11 中 的 一 个 构件 正 承受 到 弯曲 载荷 ， 早 已 证 实 这 对 结构 刚性 是 非常 不 
利 的 。 还 有 其 他 的 结构 配置 ， 如 图 7. 12 和 图 7. 13 所 示 ， 但 利用 这 样 的 配置 可 能 
需要 重新 设计 某 些 机 构 。 





图 7.11 龙门 空间 结构 
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图 7.12 由 6 个 构件 看 合 的 四 面体 结构 与 框 式 结 构 





图 7.13 从 三 角形 平面 结构 耦合 到 6 个 构件 四 面体 空间 结构 


如 果 地 面 是 空间 结构 中 要 加 上 的 另 一 个 刚体 ， 那 么 空间 结构 支撑 的 设计 可 以 
认为 是 类 似 两 个 空间 结构 耦合 在 一 起 ， 即 需要 6 个 反作用 力 来 严格 约束 空间 结 
构 。 图 7. 14 所 示 为 6 个 支撑 构件 的 一 些 安排 方法 ， 以 约束 空间 结构 。 

一 个 、 两 个 或 三 个 反作用 力 的 支撑 实例 如 图 7. 15 所 示 。 

这 种 设计 方法 被 认为 是 运动 学 设计 ， 需 要 使 用 界面 上 的 点 接触 。 不 幸 的 是 ， 
这 种 方法 存在 一 些 缺 点 。 

“1) 负载 有 限制 。 

2) 刚度 可 能 太 低 。 
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2 个 反作用 力 支 2 个 反作用 力 支撑 
个 反作用 力 支撑 3 个 反作用 力 支撑 


a) b) 


图 7.14 6 个 支撑 构件 的 一 些 安排 方法 
a) 三 对 反作用 力 的 集合 b) 3-2-1 结构 的 反作用 力 





图 7.15 支撑 实例 
a) 一 个 反作用 力 b) 两 个 反作用 力 c) 三 个 的 反作用 力 


3) 低 阻尼 。 

但 是 ,通过 半 运 动 学 的 设计 可 以 克服 运动 学 设计 的 缺点 。 这 种 方法 是 对 运动 
学 设计 的 修改 ， 它 的 目标 是 要 克服 纯 运动 学 设计 的 局 限 。 直 接 的 方法 是 将 所 有 的 
点 接触 变 为 小 的 面 接触 ， 如 图 7. 16 所 示 。 这 样 做 减少 了 接触 应 力 ， 但 增加 了 刚 
度 和 承载 能 力 。 然 而 ， 面 接触 应 保持 在 一 个 合理 的 小 区 域 。 

本 节 只 说 明了 设计 刚体 和 静 定 机 械 结构 的 一 些 基本 概念 。 有 兴趣 的 读者 可 参 
Bi] (APT, 1999 Æ) 使 用 精确 约束 设计 机 器 原理 中 的 更 详细 的 内 容 。 
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= 己 王 


a) b) c) 


刚度 增加 
图 7. 16 运动 学 与 半 运 动 学 设计 
a) 理想 条 件 一 一 点 接触 b) 线 接触 c) 面 接触 





7.2 自 适应 陷 波 器 


消除 /抑制 不 良 窗 带 波段 频 率 的 任务 可 以 用 陷 波 器 〈 即 带 阻 滤波 器 ) 高 效率 
地 完成 。 理 想 情 况 下 ， 滤 波 器 高 度 衰减 特定 的 频率 成 分 ， 并 且 保 证 其 他 频率 相对 
不 受 影响 。 因 此 ， 一 个 理想 的 陷 波 器 对 所 有 频率 有 单位 增益 ， 并 在 空 值 频率 有 零 
增益 。 一 个 单 陷 波 器 对 消除 单一 频率 或 窄带 干扰 有 效 ， 一 个 多 陷 波 器 可 用 来 消除 
多 个 窗 带 信号 ， 所 以 是 应 用 时 消除 谐 波 所 必需 的 部 件 。 
数字 陷 波 器 广泛 用 于 从 噪声 信号 中 恢复 正弦 信号 ， 消 除 正弦 干扰 ， 跟 踪 和 提 
高 宽带 噪声 中 的 时 变 窄带 信号 。 在 雷达 、 信 号 处 理 、 通 信 、 生 物 医学 工程 及 控 
制 /仪表 系统 的 领域 已 经 得 到 广泛 的 应 用 。 
为 了 在 标准 频率 By 上 创造 一 个 滤波 器 频率 响应 空 值 ， 一 个 复 共 斩 零 点 对 可 
以 分 别 以 上 Ap。 的 角度 引进 到 单位 圆 上 。 零 点 定义 为 
z12 =e = cosgo + jsinB, (7.8) 
其 中 ， 标 准 空 值 频率 B。 定义 为 
Bo = 20 ft (7.9) 
上 是 采样 频率 (Hz 或 弧度 ) 和 hh 是 陷 波 频率 (Hz 或 弧度 ) 。 这 就 产生 一 个 有 限 
脉冲 响应 (FIR) 滤波 器 为 
H(z) =1 -2cosBoz- +z” (7.10) 
有 限 脉冲 响应 (FIR) 滤波 器 有 一 个 比较 大 的 缺口 带宽 ， 这 意味 着 在 所 希望 
的 空 值 频率 附近 的 频率 成 分 也 有 严重 的 训 减 。 引 人 复 共 斩 极 点 对 ， 频 率 的 响应 可 
以 得 到 改善 。 极 点 以 +Bo 角度 放 在 半径 a 的 圆 内 。 因 此 ， 极 点 定义 为 
Pi2 = ae “Fo = a( cosBo +jsinBy ) (7.11) 
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其 中 ， 稳 定 的 滤波 器 a<1， 以 及 1 -a 是 极点 和 零点 之 间 的 距离 。 极 点 在 空 值 频 

率 附近 引进 了 共振 ， 从 而 减少 了 带宽 的 缺口 。 滤 波 器 的 传递 函数 为 
(z-z) (z-z) 

(z -p,)(z-p2) 

TARA, Eaz 和 p; 的 表达 式 ， 由 此 产生 的 滤波 器 有 以 下 传递 函数 


2 


H(z) = (7. 12) 


Go +az 十 022 
145,27! +b”? 
1 —2cosB)z7' +277 
=] -2acosByz' + az 
因此 ， 滤 波 信号 数据 y 可 以 从 原始 信号 u 获得 ， 通 过 下 列 时 域 递 推 公式 
y(n) =aou(n) +au(n-1) +a,u(n-2) -bu(n-1) -bu(n-2) (7.15) 
其 中 ， 系 数 a; Mh, 可 以 从 方程 (7.13) 和 (7.14) 推出 ， 取 代 了 时 间 移 位 运算 
F zo 
陷 波 器 的 带宽 和 因子 Q 分 别 为 
BW- 220 =a") 
[16 -2a(1 +a)" ]? 
_ [16-2a(1+a)’]? 
OF ae 2./2(1-a7) 
H (2) 在 单位 圆 上 有 零点 。 这 意味 着 空 值 频率 Bu 的 传输 增益 为 零 。 有 趣 的 是 ， 
方程 (7. 14) 的 滤波 器 结构 通过 分 别 调整 8,。 和 a 可 独立 调整 空 值 频 率 和 3dB E 
减 的 带宽 。 陷 波 滤波 器 的 性 能 取决 于 选择 控制 带宽 BW 的 a。 带宽 是 极点 和 零点 
(1-a) 距离 的 函数 ，a 通 近 单位 1 时 缩小 。 显 然 ， 当 a 接近 1， 比 如 a =0.995, 
相应 传递 函数 的 特性 是 一 个 完美 的 陷 波 滤波 器 。 
完美 的 窗 带 干扰 抑制 需要 对 滤波 器 参数 进行 精确 的 调整 ， 以 配合 共振 频率 的 
缺口 。 如 果 被 抑制 的 窄带 干扰 真实 频率 是 稳定 的 和 先 验 已 知 的 ， 可 以 使 用 固定 频 
率 和 固定 带宽 空 值 陷 波 器 。 但 是 ， 如 果 没 有 任何 先 验 信息 或 当 共振 频率 随时 间 漂 
it, WRITE 〈( 即 w=1) ， 固 定 缺 口 可 能 不 能 与 期 望 的 空 值 频率 带宽 匹 
配 。 在 这 种 情况 下 ， 积 极 建议 使 用 可 调式 / 自 适 应 陷 波 器 。 阿 尔 斯 特 罗 姆 ( Ahl- 
strom) 、 汤 普 金 斯 (Tompkins) (1985 年 ) 和 格 洛 弗 (Glover) (1987 Æ) 建议 
， 利用 自 适 应 滤波 器 带宽 ,来 容纳 空 值 频率 的 漂移 ; 波恩 坦 (Bertran) MRE 
(Montoro) (1998 Æ) 建议 用 一 个 积极 补偿 器 来 压制 振动 信号 。 关 (Kwan) 和 
AT (Martin) (1989) 改变 了 空 值 频率 Bo ， 而 保持 极点 半径 a 不 变 。 换 句 话 说， 
方程 (7.13) 的 参数 a, Ab, 进行 了 调整 ， 这 样 在 陷 波 中 心 不 处 于 所 需要 频率 的 
同时 ， 保 留 了 陷 波 器 空 值 带宽 。 


H(z) = (7. 13 ) 





- (7.14) 


(7.16) 


(7.17) 
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7.2.1 快速 傅 里 时 变换 


离散 傅 里 时 变换 (DFT) 是 一 个 将 离散 时 间 变 换 到 离散 频 域 的 工具 。 它 是 
一 种 通用 的 离线 方法 ， 广泛 用 于 设计 所 需 滤波 器 来 获取 频率 分 布 的 信息 。 然 
而 ， 在 规定 计算 的 效果 方面 ， 直 接 计算 DFT 的 成 本 是 很 高 的 。 幸 运 的 是 ，FFT 
在 数学 上 与 DFT 等 价 。 当 两 个 权 的 样本 数 是 n 时 ， 对 实现 计算 目标 FET 是 一 个 
更 有 效 的 应 用 选择 。 对 随时 间 漂 移 相 关 的 振动 频率 ，FFT 应 用 可 以 不 断 得 到 最 新 
n 个 样本 ， 更 新 信号 频谱 信号 。 根 据 最 新 的 频谱 ， 滤 波 特性 可 连续 调节 进行 陷 波 
校准 。 


7.2.2 模拟 


计算 机 模拟 对 自 适 应 陷 波 器 的 应 用 有 很 大 的 帮助 ， 为 基于 永 磁 直 线 电动 机 
(PMLM) 的 精确 定位 系统 抑制 了 不 良 的 频率 在 控制 系统 中 传输 。 计 算 机 模拟 要 
密切 跟踪 一 个 正弦 轨迹 并 有 不 良 振动 的 模拟 信号 ， 振 动 信号 从 第 一 个 周期 轨迹 频 
率 的 500Hz 漂移 到 第 二 周期 轨迹 频率 的 505Hz。 图 7. 17 所 示 为 没有 陷 波 滤波 器 
精密 机 械 的 跟踪 性 能 。 图 7. 18 所 示 为 使 用 固定 陷 波 器 时 的 性 能 ， 图 7. 19 所 示 为 
使 用 自 适 应 陷 波 器 时 的 性 能 。 显 然 ， 对 时 间 不 变 罕 带 振动 信和 号 只 用 一 个 固定 的 陷 
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图 7.17 没有 陷 波 滤波 器 精密 机 械 的 跟踪 性 能 
a) WH b) 期 望 轨迹 c) 控制 信号 
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图 7.19 使 用 自 适 应 陷 波 器 时 的 性 能 
a) 误差 b) 期 望 轨迹 c) 控制 信号 
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波 器 可 有 效 地 消除 。 然 而 ， 当 振动 频率 漂移 时 ， 自 适应 陷 波 器 能 够 检测 漂移 和 校 
准 缺口 ， 消 除 很 短暂 的 不 良 频率 。 


7.2.3 试验 


使 用 圆 简 形 直线 电动 机 线性 驱动 器 (LD3810) 与 雷 尼 绍 (Renishaw) 有 效 
分 辨 率 为 lum 的 光学 编码 器 装置 作为 试验 平台 ， 实 现 一 个 控制 系统 陷 波 器 。 
图 7. 20 所 示 为 没有 使 用 滤波 器 的 直线 电动 机 (PMLM) 的 性 能 。 
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图 7.20 没有 使 用 陷 波 器 的 直线 电动 机 的 性 能 
a) 误差 b) 所 需 的 轨迹 c) 控制 信号 


图 7. 21 所 示 为 陷 波 滤波 器 加 入 到 控制 系统 时 ， 控 制 性 能 得 到 了 改善 。 
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图 7.21 使 用 陷 波 滤波 器 的 性 能 
a) 误差 
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图 7.21 使 用 陷 波 滤波 器 的 性 能 〈 续 ) 


b) 期 望 轨迹 


7.3 实时 振动 分 析 仪 


c) 控制 信号 


本 节 将 介绍 另 一 种 机 械 振动 的 实时 监测 和 分 析 方 法 。 这 种 方法 的 主要 思想 
是 以 “可 接受 ”或 “健康 ”振动 模式 的 模式 识别 为 基础 ， 构 造 一 个 振动 特征 。 


振动 分 析 仪 可 以 运行 在 三 种 模式 : 学 习 、 


监测 和 诊断 模式 。 学 习 模 式 首 先 采 用 


将 产生 振动 特征 ， 在 此 基础 上 监测 和 诊断 模式 可 以 操作 。 在 监测 模式 中 ， 利 用 正 
常 闭 环 控制 的 机 械 ， 分 析 仪 只 使 用 自然 产生 的 振动 信号 推导 出 机 械 的 条 件 。 没 有 
刻意 的 和 额外 的 信号 输入 到 计算 机 。 超 过 一 个 标准 可 用 于 评价 机 械 条 件 时 ， 这 种 
情况 下 融合 方法 可 以 基于 多 个 输入 用 来 提供 一 个 输出 〈 机 械 状态 ) 。 在 诊断 模式 


中 ， 明 确 有 信号 输入 到 机 器 ， 输 出 的 信 
号 〈 振 动 ) 被 记录 ， 用 来 分 析 相 关 的 振 
动 特征 。 下 面 介绍 该 分 析 仪 的 各 组 成 部 
分 和 功能 。 

实时 振动 分 析 仪 的 框图 如 图 7. 22 所 
示 。 它 是 由 安装 在 机 器 上 的 加 速度 计 进 
行 监测 。 加 速度 计 测量 多 频 振动 信号 ， 
并 传输 到 一 个 智能 DSP 模块 上 。 这 个 模 
块 可 以 是 一 个 独立 的 设备 ， 也 可 以 集成 
到 对 应 的 个 人 计算 机 (PC) 上 。 振动 分 
析 算 法 下 载 到 这 个 DSP 模块 。 有 了 这 个 
操作 算法 ， 它 能 够 确定 判断 机 械 的 条 件 


机 器 





加 速度 计 


振动 信号 DSP 模块 
图 7.22 实时 振动 分 析 仪 的 框图 
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是 否 处 于 预先 确定 的 可 接受 的 阅 值 范围 内 。 如 果 条 件 被 确定 为 差 ，DSP 模块 将 触 
发 报警 ， 使 操作 员 采 取 纠 正 行动 。 

实时 振动 分 析 仪 ， 只 需要 商品 化 低 成 本 的 元 件 ， 所 以 比较 便宜 。 新 型 微机 
械 加 速度 计 大 幅 减 少 了 成 本 和 所 需 的 信号 调理 电路 。 这 些 新 型 表面 微机 械 传 感 
器 的 成 本 比 曾经 是 标准 的 压 电 状 态 监 测 仪 的 成 本 低 。 此 外 ， 典 型 的 微机 械 传 感 
器 的 灵敏 度 将 保持 在 工业 温度 的 1% 公差 范围 内 ， 从 而 免除 了 温度 补偿 和 校准 
的 需要 。 可 以 轻松 安装 ， 因 为 加 速度 计 能 够 独立 于 机 器 本 身 的 控制 ， 来 收集 振 
动 信 号 。 因 此 ， 不 会 破坏 任何 机 器 的 运行 。 这 里 的 样机 中 ， 独 立 DSP 模块 使 用 
美国 德州 仪器 公司 的 DSP 仿真 器 板 (TMS320C24x 模式 ) 。 这 个 C24x 系列 仿真 器 
板 是 围绕 F240 DSP 控制 器 构建 的 ， 以 20MIPS 速度 运行 ， 指 令 周 期 为 50ns。 该 
技术 优化 了 数字 电动 机 控制 和 转换 系统 。 其 他 支持 这 个 DSP 模块 的 关键 部 件 是 
模 数 转换 器 (ADC)、 双 寻 址 存储 器 RAM (DARAM) 、 片 上 闪存 和 RS-232 兼容 
的 串 行 端口 。 振 动 分 析 算 法 被 评估 满意 并 在 计算 机 上 测试 后 ,将 下 载 到 DSP 板 
Eo XA DSP 模块 和 加 速度 计 仅 满 足 了 实时 振动 分 析 仪 〈( 见 图 7.22) 的 硬件 
要 求 。 


7.3.1 学 习 模 式 


在 学 习 模式 中 ， 机 器 在 正常 条 件 下 运作 的 振动 信号 ， 被 加 速度 计 获 得 并 存储 
在 DSP 模块 中 。 从 振动 信号 中 提取 出 一 个 合适 的 振动 特征 (Ramirez 1985 年 ) 
有 许多 类 型 的 振动 特征 可 适用 于 机 器 监控 。 例 如 ， 一 种 振动 特征 的 形式 可 以 是 基 
于 振幅 的 ; 另 一 种 形式 可 以 是 基于 振动 时 间 序 列 分 析 的 ; 还 可 能 的 另 一 种 形式 就 
是 基于 FFT 算法 应 用 可 以 得 到 振动 的 有 效 光 谱 。 在 这 里 ， 振 动 信号 的 频谱 用 来 
作为 特征 的 重要 组 成 部 分 。 无 论 形式 如 何 ， 振 动 特征 还 取决 于 驱动 机 器 的 输入 信 
号 的 类 型 。 例 如 ， 方 波 输 入 产生 的 振动 频谱 与 尖 鸣 信号 输入 〈 频 率 增 加 的 重复 
正弦 波 ) 或 纯正 弦 波 相当 不 同 。 因 此 ， 一 个 特定 的 输入 信和 号 将 产生 一 个 独特 的 
频谱 ， 在 此 基础 上 可 以 得 出 唯一 的 振动 特征 。 为 了 机 器 的 诊断 和 监测 功能 ， 因 而 
需要 对 应 获得 自然 振动 机 器 的 多 个 振动 特征 〈 监测 模式 中 非常 有 用 ) ， 或 对 应 不 
同 的 输入 信号 的 多 个 振动 特征 (诊断 模式 中 有 用 ) 。 


7.3.2 监测 模式 


在 监测 模式 中 ， 为 监测 机 器 的 振动 信号 对 机 器 进行 定期 采样 。 没 有 考虑 或 额 
外 的 输入 信号 是 必需 的 ， 所 以 机 器 不 必 中 断 运行 。 更 新 后 的 光谱 用 来 分 析 相 关 的 
振动 特征 。 分 析 和 比较 可 能 是 频率 的 移动 或 频谱 的 幅 值 ， 或 者 是 两 者 的 结合 。 例 
如 ， 一 个 评价 标准 (EV) 的 可 能 是 基于 当前 实时 振动 光谱 和 振动 特征 值 的 均 方 
(ms) 差 值 ( 拉 米 雷 斯 1985 Æ) 
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2 "5, ~ Ss; y? 
N 
其 中 ，5$, 是 当前 高 散 化 的 实时 振动 光谱 ，5S。 是 相应 的 振动 特征 ，g 是 为 数据 点 
指数 ，N 是 数据 点 的 总 数 。 基 于 当前 时 间 系 列 振动 模式 幅度 及 相应 的 振动 特征 的 
差 ，EV 可 以 有 另 一 种 形式 
EV, =max(T,) -max( T% ) (7.19) 
其 中 ，max (7,) 代表 当前 时 间 系 列 振动 模式 T, 的 最 高 振幅 ，max (TS) 为 其 
相应 振动 特征 最 高 的 幅度 。 
决定 机 器 的 状态 的 评价 标准 不 止 一 个 。 在 这 种 情况 下 ， 融 合 技 术 是 必要 的 。 
融合 技术 的 关键 概念 是 相关 联机 器 的 HEALTH 属性 ， 它 是 一 个 由 多 个 评价 计算 
的 标准 。 这 些 标准 在 不 同 程度 上 预计 影响 机 器 的 HEALTH 属性 。 因 此 ，HEALTH 
属性 是 各 种 标准 (EV) 适当 的 函数 从 ， 即 
HEALTH = Š (EV, ,EV, ,…,EV，) (7. 20) 
Ht, n 称 为 评估 标准 的 数目 。 
一 种 模糊 加 权 方 法 可 以 用 来 实现 函数 SD 。 
HEALTH 属性 处 理 为 一 个 模糊 的 变量 ( 即 HEALTHe [0, 1])。HEALTH=0 
将 反映 绝对 机 器 故障 ， 而 HEALTH =1 反映 了 一 个 完全 正常 的 机 器 状态 。 这 
个 属性 可 以 由 模糊 运算 进行 计算 ， 结 合 评价 标准 的 (EV) 通过 对 振动 信号 
的 特征 分 析 获 得 。 关 于 机 器 的 条 件 将 最 终 由 HEALTH 属性 决定 ， 作 为 可 选择 
的 一 个 数学 分 支 ， 有 兴趣 的 读者 可 以 参考 扎 德 在 1973 年 关于 模糊 逻辑 的 论 
在 这 里 应 用 的 类 型 是 塔 科 西 (Takagi) 与 苏 克 诺 (Sugeno) 在 1985 年 的 模 
糊 推理 。 考 虑 p 规则 属性 的 计算 机 语言 描述 为 
IF EVİ IS Fi QEV‘ IS F THEN ui =a’ ,i=1+-p (7.21) 
we (0, 1) 为 一 尖 鸣 可 变 输出 ， 表 示 第 i 个 评价 准则 影响 最 终结 果 的 程度 。 因 
i, a 代表 第 i 规则， 具有 2 ,a =1。F 代表 模糊 集 在 其 输入 语言 变量 (EV;) 
中 进行 了 评价 。 思 是 一 个 模糊 结合 运算 符 。 
该 属性 的 值 被 评价 作为 wi 的 加 权 平 均 计算 值 


EV, = 





(7. 18) 


EHALTH = 一生 :一 一 (7. 22) 

其 中 ， 权 w, 包含 主要 规则 i 的 全 部 输入 真 值 ， 它 的 计算 方法 为 
w = IT} py (EV;) (7. 23) 
py (EV!) 是 关于 输入 语言 变量 EVi (第 i 个 规则 ) 模糊 集合 Fi 的 隶属 函数 。 例 
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如 ， 在 这 个 应 用 中 ， 评 价 标准 (EV) 可 以 是 最 大 的 误差 (MAX_ERR) Fi 可 以 
是 模糊 集 HIGH, 
隶属 函数 ncn (MAX_ERR) 可 能 有 如 图 7. 23 所 示 的 特征 。 然 后 决定 是 否 
有 必要 纠正 可 以 基于 一 个 简单 的 下 -THEN-ELSE 公式 如 下 
IF HEALTH <y,THEN STRATEGY = TRIGGER ALARM 
ELSE STRATEGY = CONTINUE TO MONITOR 
y 可 以 看 做 是 一 个 阔 值 。7 适当 的 值 可 能 为 0.6<y<0.9。 


uoy (MAX_ERR) 


MAX ERR 


图 7.23 输入 MAX_EER Ñ uncu (MAX_ERR) 的 隶属 函数 


根据 这 一 框架 ， 可 以 相对 容易 地 选用 另外 的 准则 分 析 和 决策 系统 。 该 过 程 涉 
及 设立 标准 的 隶属 函数 ， 制 定 模糊 规则 的 补充 规定 和 调整 标定 ， 参 数 方程 
(7.21) 的 a 反映 了 新 准则 对 现存 准则 的 相对 权重 。 

根据 监测 模式 ， 预 示 着 在 达到 不 利于 机 器 振动 水 平 以 前 ， 就 可 以 看 到 机 器 振 
动 的 趋势 。 


7.3.3 诊断 模式 


在 诊断 模式 中 ， 经 过 深思 熟 虑 的 明确 的 信号 输入 机 器 ， 并 且 对 应 每 个 输入 信 
号 的 振动 信号 都 分 析 了 相关 的 特征 ， 这 取决 于 机 器 的 类 型 。 类 似 监 控 模 式 ， 可 以 
有 多 种 评价 标准 用 于 诊断 模式 ， 前 面 描述 的 融合 技术 这 里 也 同样 适用 。 

必须 精心 设计 适用 于 机 器 的 输入 信和 号， 以便 在 操作 管理 的 角度 下 产生 尽 可 能 
多 的 机 器 状态 信息 。 对 于 输入 信号 ， 两 个 重要 的 考虑 是 选择 幅度 和 频率 。 

机 器 可 能 有 运行 限制 ， 过 大 的 输入 信号 的 幅度 由 于 运行 限制 对 机 器 可 能 是 不 
可 行 的 ， 甚 至 可 能 损坏 机 器 。 另 外 ， 应 选择 输入 的 频率 带 ， 这 个 频率 范围 对 于 能 
源 系统 是 最 重要 的 。 输 入 信和 号 不 适用 于 在 开 环 系统 时 ， 设 定点 信号 将 作为 闭环 系 
统 的 输入 ， 因 为 它 在 闭环 控制 下 可 能 无 法 直接 访问 系统 。 对 上 述 问题 要 进行 仔细 
考虑 ， 确 保 可 从 机 器 获得 重要 的 信息 。 
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7.3.4 试验 
在 这 里 介绍 作为 测试 平台 使 用 的 振动 台 ， 如 图 7. 24 所 示 。 


E 





图 7.24 测试 平台 一 一 振动 台 


振荡 器 可 以 用 来 模拟 机 械 振动 ， 并 评估 主动 质量 阻尼 器 的 性 能 。 振 荡 器 的 动 
力 是 由 一 个 高 扭矩 电动 机 直接 驱动 。 振 功 器 的 最 大 线性 行程 为 +2cm。 振 荡 器 是 
通过 一 个 独立 的 控制 模式 DSP 模块 实现 的 ， 采 用 美国 德州 仪器 公司 的 DSP 仿真 
器 板 〈TMS320C24x 模型 ) 。 振 动 分 析 和 监测 方案 是 用 C24x 汇编 语言 编写 的 。 对 
于 远程 监测 的 目的 ， 也 可 以 用 一 个 通用 数据 采集 及 控制 电路 板 控制 。 

学 习 方 式 先 启动 ， 以 获得 振荡 器 在 正常 操作 条 件 下 的 振动 信和 号。 在 试验 中 ， 
假设 正常 情况 输入 是 对 应 的 方 波 信号 。 为 了 实现 诊断 模式 的 目的 ， 振 动 信号 也 可 
以 从 正弦 波 和 尖 鸣 输入 信号 得 到 。 

1. 输入 变量 -评价 标准 

EV 的 不 同类 型 可 以 用 作 决 定 本 机 条 件 的 输入 变量 。 对 这 种 振动 分 析 应 用 ， 
为 HEALTH 属性 选择 输入 变量 ， 相 应 的 不 同 操 作 模 式 的 计算 如 下 

(1) 监控 模式 


N 


>, (So pe Sead 











a ss (7.24) 
ppe Tang) a Paa (7.25) 
M 
(Ta. Ta. )? 
ie De ger Pag Te (7.26) 
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HF, Saaf 了 .分 别 代表 振动 谱 和 时 间 域 信号 ， 对 应 于 一 个 方 波 输入 。N 为 离 

sal 普 的 频率 数 ，M 是 一 个 运行 周期 内 时 间 序 列 数 据点 的 数目 。 因 此 ,EV, 为 振动 

谱 与 特征 之 间 的 均 方差 ,EV, 为 超过 一 个 运行 周期 振动 信号 的 幅度 相 比 特征 之 间 

差 的 平方 EV, 是 超过 一 个 运行 周期 振动 信号 及 其 特征 (时 域 ) 之 间 的 均 方差 。 
(2) 诊断 模式 








EV, = (7.27) 
N 
(Song Z Souq)” 
EV, = È p- i as (7.28) 
E” (Sag Z Sq)? 
EV, = 一 一 全 一 一 (7. 29) 


其 中 ， 下 角 cp 表示 一 个 尖 了 鸭 输 入 信和 号， 下角 sn 表示 一 个 正弦 输入 信和 号 。 

监测 模式 下 ， 输 入 属性 只 涉及 方 波 输入 ， 在 正常 操作 条 件 下 ， 输 入 信号 是 方 
波 信和 号。 

2. 评价 规则 

为 HEALTH 属性 计算 的 三 个 规则 是 : 

(1) 监控 模式 

IFEV, IS LOW, THEN u =, 

IFEV, IS SHORT, THEN u =,,, 

IFEV, IS LOW, THEN u =p,. 
定 标 参 数值 ， 即 方程 (7.21) 的 a 值 ， 反映 了 本 机 HEALTH 决定 模糊 规则 的 相 
对 重要 性 。 使 用 的 定 标 值 为 a =0.4, a, =0.3, a, =0. 3. 

各 自 的 隶属 函数 是 

p;(EV,) se i = 1-3 

其 中 , n 和 B 是 EV 标 称 化 的 定 标 因子 。 在 此 应 用 中 ,它们 分 别 为 n = 10, 
B=0.5, 

(2) 诊断 模式 

IFEV, IS LOW, THEN u =p, 

IFEV, IS LOW, THEN u =, 

IFEV, IS LOW, THEN u = pgo . 
EAR IME a, =0.4, a, =0.4, a, =0.2。 类 似 的 隶属 函数 用 来 作为 监测 
模式 。 

该 机 条 件 属性 HEALTH ， 然 后 按 公式 (7.22) 计算 。 

3. 测试 
根据 监测 和 诊断 模式 提供 的 实时 检测 结果 ， 验 证 该 设备 的 可 操作 性 。 
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(1) 监测 模式 ”在 监测 模式 中 ， 正 常 输入 信号 ( 即 方 波 ) 输入 到 振动 器 系 
统 。 在 1=5 时 ,人 额外 频率 f=5Hz 的 正弦 信号 也 输入 到 系统 ， 以 模拟 机 器 出 现 故 
障 。 本 机 (对 应 方 输入 ) 的 时 域 信号 如 图 7. 25 所 示 。i =5 前 后 机 器 的 频谱 分 别 
如 图 7.26 和 图 7.27 所 示 。 振 动 分 析 算 法 能 够 检测 机 器 故障 。 该 振动 表 属 性 
HEALTH 下 降 到 0.2， 低 于 阔 值 (设置 为 0.6) 。 报 警 被 触发 。 


LS 











0 1000 2000 3000 4000 5000 6000 7000 8000 9000 10000 
时 间 /ms 
图 7.25 输入 信号 为 方 波 对 应 的 时 域 信号 (在 1=5 时 ， 模拟 故障 ) 


40 








35> 


30 











0 10 20 30 40 50 60 70 80 90 100 
频率 /Hz 


图 7.26 对 应 方 波 输入 信和 号 的 机 器 频谱 
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0 10 20 30 40 50 60 70 80 90 100 
频率 /Hz 


图 7.27 发 生 上 故障 后 对 应 方 波 输入 信号 的 机 器 频谱 
(2) 诊断 模式 ”在 诊断 模式 中 ,不 同 的 输入 信号 EZE, TEMRE) 
可 对 应 使 用 。 为 了 在 上 =5 模拟 发 生 故 障 ， 输 入 的 增益 在 :=5 时 增加 了 两 倍 。 
对 应 于 尖 鸣 信号 的 振动 信号 如 图 7. 28 所 示 。 





-0.8 1 1 1 1 ss J 
0 1000 2000 +3000 4000 5000 6000 7000 8000 9000 10000 
时 间 /ms 





图 7.28 对 应 于 尖 鸣 输入 信和 号 的 振动 信号 〈 在 上 =5 时 ， 模 拟 故障 ) 
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t=5 前 后 机 器 的 频谱 (对 应 于 尖 鸣 信号 ) 分别 如 图 7.29 和 图 7. 30 所 示 。 
机 器 的 振动 时 域 信 号 〈 对 应 于 正弦 波 输入 ) 如 图 7.31 所 示 。t =5 前 后 机 器 的 谱 
(对 应 于 正弦 波 输入 ) 分 别 如 图 7. 32 和 图 7. 33 所 示 。 


20 











ain 10 
= 
8 
6 
4 
2 
0 10 20 30 40 50 60 70 80 90 100 
频率 /Hz 
图 7.29 对 应 于 尖 鸣 输入 信号 的 机 器 频谱 
20 
18 
16 
14 
12} 
= 10 
8 
6 
4 
2 
0 10 20 30 40 50 60 7 80 90 100 


频率 /Hz 
图 7.30 发 生 故 障 后 对 应 尖 鸣 输入 信和 号 的 机 器 频谱 
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A 1 1 1 1 1 
0 1000 2000 3000 4000 5000 6000 7000 8000 9000 10000 
时 间 /ms 


图 7.31 对 应 于 正弦 输入 信号 的 振动 信号 〈 在 上 =5 时 ,模拟 故障 ) 





0 10 20 30 40 50 60 70 80 90 100 
频率 / Hz 


图 7. 32 对 应 于 正弦 输入 信号 的 振动 特征 
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0 10 20 30 40 


50 60 70 80 90 100 
频率 /Hz 


图 7.33 发 生 故 障 后 机 器 对 应 的 正弦 输入 信号 的 机 器 频谱 


振动 分 析 算 法 能 够 检测 到 在 机 械 故 障 。 该 振动 器 的 HEALTH 属性 下 降 到 
0.1, (RFRA (RBA 0.6), ， 触 发 相应 的 警报 。 


7.3.5 远程 监控 


对 直接 来 自 车 间 层 的 生产 数据 的 高 效 组 织 和 可 用 性 ， 对 制造 公司 的 竞争 力 和 
反应 能 力 是 非常 重要 的 。 目 前 ， 整 个 工厂 的 布局 可 以 相当 广泛 ， 在 一 些 情况 下 ， 跨 
洲 传 播 的 生产 数据 更 为 重要 。 因 此 ， 远 程 监测 和 控制 是 必要 和 非常 有 用 的 ， 而 既 耗 
费时 间 效 率 又 低下 的 实际 系统 不 必 存 在 了 。 对 所 属 分 支 生 产 厂 的 机 器 进行 远程 监测 
的 办 法 ， 是 利用 现 有 可 扩展 的 TCP/IP 的 基础 设施 。 本 节 将 介绍 这 一 内 容 。 

1. 硬件 

需要 和 使 用 的 硬件 方面 ， 远 程 监控 发 展 的 服务 器 端 ， 由 一 个 安装 在 PC 上 的 数 
据 采集 卡 组 成 。 数 据 采集 卡 有 多 种 类 型 可 用 。 这 里 用 的 采集 卡 是 美国 国家 仪器 公司 
的 产品 。PC 主要 用 于 数据 采集 和 远程 机 器 的 控制 。 硬 件 连接 如 图 7. 34 所 示 。 

2. 软件 

实现 远程 监测 会 议 的 主要 思路 是 向 客户 提供 所 需 的 数据 。 在 客户 端 ， 它 允许 
客户 端 通过 CGI 接口 的 Web 浏览 器 监测 和 控制 远程 机 器 和 工厂 。 从 本 质 上 讲 ， 
长 距离 远程 监控 应 用 与 其 他 网 络 应 用 主要 由 两 部 分 组 成 : 客户 端 和 服务 器 端 。 客 
户 端 是 一 个 简单 的 Web 浏览 器 。 在 服务 器 端 ， 因 特 网 开发 工具 包 提供 的 Lab- 
VIEWs 是 唯一 需要 的 重要 软件 。 该 软件 的 要 求 及 互动 如 图 7. 35 所 示 。 
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Web/ HTTP AR 4 3§ 
G-Web 服 务 器 


















a TCP/IP 


Web 浏览 器 
例如 Netscape 浏览 器 


Vis 面板 图 像 
















远程 机 器 





LabVIEWs 
虚拟 仪器 









图 7.35 LabVIEW 的 要 求 及 互动 


3. 工作 原理 
互联 网 开发 工具 包 对 LabVIEW 是 一 个 附加 组 件 。 它 实质 上 是 一 个 转换 虚拟 
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仪器 (VIA) 成 互联 网 功能 应 用 的 库 集合 ， 如 电子 邮件 和 FTP。 首 先 最 重要 的 
是 万 维 网 ， 该 工具 包 组 成 了 G Web 服务 器 。 它 能 够 作为 一 个 虚拟 仪器 (VI) 的 
前 面板 ， 可 以 从 客户 端的 Web 浏览 器 中 查看 图 片 。 基 本 上 有 两 种 服务 方式 。 一 
是 “快照 ”模式 ， 前 面板 的 图 像 快照 将 送 达 。 二 是 监测 模式 ， 在 这 种 模式 下 ， 
送 达 用 户 的 该 面板 图 像 被 嵌入 了 动画 的 效果 。 这 是 服务 器 推送 技术 实现 的 。 连 续 
的 面板 图 像 帧 将 从 服务 器 接连 推 到 其 他 的 客户 端 ， 而 无 需 等 待 随后 客户 端 再 次 任 
务 请 求 。 推 帧 的 速率 可 以 在 G Web 服务 器 的 配置 文件 中 设置 。 目 前 ， 只 有 网 景 
公司 的 浏览 器 支撑 服务 器 推送 技术 。 其 他 Web 浏览 器 ， 特 别 是 微软 的 TE 浏览 
器 ， 也 可 以 创建 为 动画 。 这 将 导致 G Web 服务 器 传送 前 面板 的 图 像 工作 在 监控 
模式 ， 客 户 端 图 像 是 动画 的 。 因 此 ， 在 G Web 服务 器 为 在 互联 网 上 提供 虚拟 仪 
表 前 面板 的 图 像 提供 了 便捷 的 手段 。 

软件 包 还 包括 一 个 用 于 编写 的 CGI (通用 网 关 接 口 ) 与 G Web 服务 器 应 用 
的 程序 库 。 而 CGI 是 接口 与 信息 服务 器 (如 HTTP 或 Web 服务 器 ) 外 部 应 用 程 
序 的 标准 。 用 户 要 求 ， 例 如 通过 每 次 点 击 超级 链接 或 图 像 映射 ，URL (统一 资源 
定位 器 ) 所 对 应 的 CGI FEF, CO 程序 将 在 服务 器 实时 运行 。 

访问 安全 纳入 了 G Web 服务 器 ， 是 通过 在 指定 的 HTTP/1. 0 接 人 认证 基本 计 
划 获 得 的 。 它 是 一 个 简单 的 要 求 -响应 身份 验证 机 制 ， 服 务 器 向 客户 端 请 求 一 个 
由 客户 端 提供 的 认证 信息 。 基 于 该 模型 ， 客 户 端 本 身 必 须 进行 每 个 域 用 户 名 和 密 
码 身 份 验证 。 仅 当 可 以 验证 请 求 URI 保护 空间 的 用 户 名 和 密码 时 ， 服 务 器 才 响 
应 服务 请 求 。 利 用 G Web 服务 器 ， 它 也 可 以 基于 用 户 名 、 密 码 和 用 户 的 IP 地 址 
来 控制 访问 。 


7.3.6 实现 


在 客户 端 ， 操 作 员 可 通过 互联 网 发 送 指令 ， 来 远程 执行 机 器 的 振动 分 析 。 一 
个 典型 的 对 话 从 客户 端 浏 览 器 开始 。 当 用 户 成 功 认 证 ， 出 现 的 主页 如 图 7.36 所 
示 。 用 户 可 以 通过 主动 点 击 任何 超 链接 启动 任何 分 析 模 式 。 其 实 ， 这 些 超 链接 指 
向 一 个 CGI 程序 。 当 服务 器 收 到 任何 要 求 时 ， 这 个 CGI 程序 将 要 求 一 个 与 服务 
器 端的 会 话 。 在 任何 时 间 点 ， 都 只 有 一 个 对 话 可 以 进行 。 经 过 这 些 检查 ， 虚 拟 仪 
器 的 要 求 将 被 加 载 到 服务 器 的 内 存 上 。 前 面板 的 图 像 将 被 送 达 ， 分 析 的 结果 将 显 
示 。 分 析 必须 执行 的 隶属 函数 、 比 例 因 子 和 靖 值 可 以 远程 修改 。 

点 击 图 像 的 映射 或 标准 的 HTML 表单 提交 会 从 客户 端 发 送 命令 到 服务 器 。 这 
些 命令 将 通过 互联 网 服务 器 上 设置 的 TCP/IP 协议 被 发 送 。 在 服务 器 端 ,在 G 
Web 服务 器 将 收 到 客户 端 请 求 通过 指定 的 套 接 字 和 端口 号 , 一般 HTTP 为 80。 服 
务 器 将 处 理 客户 端的 请 求 ， 传 送 前 面板 的 图 像 到 客户 端的 浏览 器 。 执 行 振动 分 析 
监测 和 诊断 模式 的 浏览 器 快照 分 别 由 图 7.37 和 7. 38 给 出 。 
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This is the web site for on-\ine monitoring and diagnosing of the plant. 


Select monitoring mode (test 14 for the plant 





Select diagnostic mode itest 2) for the plant 


be 





Bie 


图 7.36 主页 














Testli Test? 





图 7.37 执行 振动 分 析 监 测 模式 的 浏览 器 快照 


-178- 精密 运动 控制 : 设计 与 实现 












人 TREE W 











atea tes competed te Font 






可 ae 有 





Heals 











图 7.38 诊断 模式 的 浏览 器 快照 


第 8 音 其 他 工程 方面 


基于 前 几 章 的 介绍 ， 控 制 系统 被 开发 
统 ， 如 图 8.1 所 示 。 该 机 器 人 系统 具有 
250mm x 400mm x 50mm 的 行程 。 其 他 工 
程 方面 ， 如 确定 元 件 的 尺寸 和 选择 、 硬 件 
架构 、 软 件 开发 平台 、 用 户 界面 设计 和 性 
能 评估 ， 对 整体 开发 工作 中 也 是 至 关 重 要 
的 。 这 些 方 面 的 详细 内 容 将 在 本 章 中 
介绍 。 


8.1 规格 


控制 规格 如 表 8. 1 所 示 。 





图 8.1 三 维 笛 卡 儿 机 器 人 系统 


表 8.1 控制 规格 










最 小 速度 v5,/( pm/s) 








最 大 速度 vw/(m/s) 





步 稳定 时 间 7,/s 


8.2 选择 电动 机 和 驱动 器 


为 构建 机 器 人 使 用 了 美国 Anorad 公司 制造 的 线性 电动 机 。 选 择 LE 系列 高 效 
无 刷 线性 伺服 电动 机 提供 78N 的 持续 力 和 191N 的 峰值 力 。 最 大 加 速度 取决 于 移 
动物 体 的 质量 和 这 个 峰值 力 。 此 外 ， 运 动 配置 必须 服从 : 运行 期 要 求 电动 机 力矩 
的 有 效 值 必须 小 于 连续 力矩 。 假 设 的 有 效 值 要 求 得 到 满足 ， 如 果 最 大 的 移动 质量 
小 于 100kg， 可 以 实现 最 大 加 速度 为 0. 2g。 
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8.3 选择 光学 编码 器 


选择 光学 编码 器 而 非 激 光 干 涉 仪 主要 是 为 了 控制 成 本 。 为 了 实现 R= 
0. Olum 的 测量 分 辨 率 ， 选 择 海 登 海 因 (Heidenhein〉 线性 编码 器 LIP481 (1Vpp 
型 ) 。LIP481 具有 T, =2um 的 信号 周期 ， 它 在 超过 220mm 时 精确 度 为 上 0. 2bm， 
420mm 精确 度 为 +0. Sum。LIP581 可 用 于 较 长 的 运行 。 它 有 4um 的 信号 周期 ， 
1440mm 精确 度 为 + lum, 

为 了 产生 一 个 尺 =0. Olam 的 分 辨 率 ,，LIP581 和 LIP481 分 别 需要 最 低 400 和 
200 的 电子 揪 值 。 为 了 使 播 值 能 有 效 运作 ， 必 须 利 用 适当 的 屏蔽 和 接地 技术 ， 尽 
量 减少 磁场 的 不 良 干 扰 影响 ， 使 测量 噪声 的 电压 低 至 SmV 以 下 。 


8.4 控制 平台 


灵活 性 、 质 量 、 功 能 和 开发 时 间 是 推动 选择 控制 系统 的 硬件 和 软件 开发 平台 
的 关键 因素 。 选择 dSPACE 开发 平台 是 依据 三 个 主要 特点 来 选择 的 : 快速 控制 原 
型 、 自 动 生 成 生产 代码 和 回路 硬件 测试 设备 。 

快速 控制 原型 意味 着 新 的 和 定制 的 控制 概念 ， 可 以 直接 和 迅速 地 开发 ， 并 可 
通过 常用 软件 如 MATLAB®/Simulink 标 准 的 设计 工具 和 丰富 的 功能 块 对 实际 系 
统 最 优化 。 控 制 器 可 以 直接 而 生动 地 以 功能 块 图 的 形式 设计 ， 很 少 或 根本 没有 必 . 
要 在 线 编程 。 实 时 代码 可 以 通过 功能 块 图 自动 生成 ， 并 实现 通过 机 器 自动 生成 代 
码 的 特性 。 回 路 硬件 设备 进一步 允许 可 靠 和 具有 成 本 效益 的 方法 ， 完 成 虚拟 环境 
下 的 系统 测试 。 外 设 部 件 可 用 已 证 明 有 效 的 数学 模型 取代 ， 而 把 要 进行 评估 的 实 
际 物理 部 件 系 统 地 搬入 回路 。 除 了 节省 时 间 和 成 本 ， 相 关 回 路 的 模块 化 和 可 再 生 
性 硬件 的 仿真 极 大 地 简化 了 整个 开发 和 测试 过 程 。 


8.4.1 硬件 结构 


整个 系统 硬件 结构 如 图 8. 2 所 示 。 为 了 满足 高 同步 速度 和 高 精度 的 要 求 ， 控 
制 单元 配置 了 高 速 处 理 模块 。dSPACE DS1004 DSP 板 和 DS1003 DSP 板 一 起 使 
用 。DS1004 DSP 电路 板 采用 DEC Alpha 的 AXP 21164 处 理 器 ， 具 有 600 MHz 
1200 MFLOPS 的 能 力 。 该 主板 用 于 执行 完全 集中 计算 密集 型 与 控制 算法 相关 的 任 
务 。DS1003 DSP 板 使 用 具有 60 MFLOPS 的 TMS320C40。 它 可 以 有 效 地 处 理 所 有 
必要 的 IO 任务 ， 因 为 可 以 通过 外 围 高 速 总 线 高 速 (PHS) 连接 到 所 有 OR. 
两 种 板 都 具备 RTI (实时 接口 )， 并 允许 从 Simulink 的 内 部 完成 编程 。 通 过 分 别 
下 放 计 算 任 务 和 LO 任务 到 DS1004 和 DS1003 这 两 块 板 ， 这 种 多 处 理 器 系统 配 
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置 提供 了 最 佳 性 能 。 
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图 8.2 整体 硬件 构架 


除了 处 理 器 板 ， 使 用 DS2001 数据 采集 板 ， 有 五 个 平行 的 高 速 16 位 A/D 通 
道 。 采 样 和 信号 保持 对 所 有 通道 可 同时 执行 ， 采样 时 间 短 短 5hs。 使 用 DS2102 
高 分 辩 率 的 D/A 板 驱 动 启动 器 。 它 有 六 个 并 行 的 D/A 通道 ， 每 个 有 16 位 的 分 辩 
率 。 典 型 的 设置 时 间 ( 满 量程 ) 为 1.3 ~2ps, 可 输出 电压 范围 (TRE) X 
+SV、+10V 或 0~10V。Ds2102 的 Simulink 块 和 RTI 一 起 提供 的 对 话 框 可 以 帮 
助 用 户 根据 连接 通道 设备 ， 自 定义 和 配置 每 个 通道 的 电压 范围 。 

为 了 通过 模拟 式 增 量 型 光学 编码 器 实现 精密 测量 的 分 辨 率 ， 增 量 式 编码 器 的 
DS3002 接口 板 选择 了 750 kHz 的 最 大 输入 频率 。 通 过 DS3002 的 六 个 通道 获取 正 
弦 编 码 器 的 信号 ， 转 换 为 12 位 数字 信和 号， 然后 通过 特殊 的 高 优化 软件 的 相位 解 
码 功能 ， 从 这 些 数 据 中 提取 相对 位 置 。 

沿 着 相对 位 置 ， 搜 索 块 寻求 编码 器 标记 线 ， 当 得 到 一 个 新 的 标记 线 绝对 位 置 
信息 时 ， 更 新 相应 的 计数 器 。 从 理论 上 讲 ， 这 样 的 方法 可 以 实现 4096 个 插值 。 
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反 过 来 ， 这 意味 着 如 果 光 栅 线 间距 为 4km， 可 以 得 到 小 于 lnm 的 测量 分 辩 率 。 
然而 ， 应 当 小 心 注意 插值 误差 的 制约 因素 ， 如 相关 的 有 限 字 长 的 A/D 操作 ， 不 
完善 的 模拟 编码 器 波形 ， 具 有 均值 和 相位 的 偏 黎 ， 品 声 及 非 正 弦 波 形 失真 〈 见 
第 6 BAR). 
带 有 32 个 IO 通道 的 DS4001 既是 计时 器 又 是 数字 IO 板 ， 用 于 检查 行程 限 
位 开关 的 状态 和 其 他 提高 安全 性 能 的 数字 化 设备 。32 通道 可 分 为 8 位 的 分 组 。 
包括 上 述 的 处 理 器 的 WO 板 在 内 ， 系 统 硬 件 建构 全 部 实现 高 度 模块 化 。LO 
板 安装 到 19 号 机 架 扩 充 盒 ， 扩 充 盒 拥有 最 多 可 安装 20 个 dSPACE 板 的 20 个 全 
尺寸 16 位 ISA 播 槽 。 扩 充 盒 中 包含 电源 、 冷 却 风扇 和 接口 电路 。 控 制 系统 采用 
面板 连接 器 ， 以 提供 方便 获取 dSPACE LO 板 的 所 有 输入 和 输出 信号 。 模 拟 信 号 
可 通过 BNC 连接 器 获得 ， 大 多 数 的 数字 信号 通过 Sub-D 连接 器 访问 获得 。 连 接 
器 面板 上 的 Sub-D 连接 器 是 低 密度 的 ， 按 VO 通道 或 功能 单元 分 组 。 
配置 的 控制 平台 能 满足 以 下 的 速度 要 求 。 
1. 最 小 速度 ; Vmin 
闭环 带宽 估计 约 为 100Hz。 因 此 ， 为 避免 混淆 ， 必 须 满 足 香农 采样 定理 ， 要 
求 采 样 频率 为 w, 宇 2 x 100Hz = 200Hz。DS2001 支持 该 采样 频率 ， 可 以 达到 低 至 
Sps 的 每 轴 伺 服 更 新 间隔 。 
插值 后 编码 器 计数 频率 应 满足 
f.>200Hz 
因此 
U min 
p 7 
Vin =2um/s 
能 够 满足 最 小 ww =Sum/so 
2. 最 大 速度 Vna 
可 实现 的 最 大 速度 关键 取决 于 控制 器 电子 电路 的 最 大 带宽 。DS3002 支持 高 
达 750 kHz 的 带宽 。 因 此 
Yna (1 x 10°)/T, <750(1000) 
Uma <1. Sm/s 
可 以 满足 w。 =0.5 m/s 的 最 大 速度 。 


8.4.2 软件 开发 平台 


流行 的 软件 设计 和 仿真 工具 支持 该 处 理 器 板 ， 包括 MATLAB@ 和 Simulink? , 
它们 为 经 典 控制 和 现代 控制 两 类 控制 算法 的 标准 和 模块 化 设计 功能 提供 了 丰富 的 
集合 。 图 8. 3 所 示 为 销 卡 儿 三维 龙 门 机 定制 的 全 部 Simulink 控制 框图 。 按 照 各 自 
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的 功能 区 分 ， 框 图 可 分 为 三 个 部 分 : 
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图 8.3 ” 笛 卡 儿 三 维 龙 门 机 定制 的 全 部 Simulink 控制 框图 


1) 控制 和 自动 调整 。 

2) 几何 误差 校正 和 补偿 。 

3) 安全 功能 ， 如 紧急 停车 和 限 位 开关 等 。 

控制 算法 包含 在 X-Chl、Y-Ctl 和 Z-Ctl 键 子 系统 中 。 图 8. 4 所 示 为 Simulink 
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X 轴 的 控制 框图 。 除 了 PID 反馈 控制 是 固定 的 以 外 ， 其 他 的 先进 控制 算法 可 由 操 
作 员 设置 。 同 时 还 为 控制 器 提供 了 自动 校正 操作 模式 。 该 操作 模式 (SARA 
动 校正 ) 可 以 通过 X-Output-Switch, Y-Output-Switch 和 Z-Output-Switch 开关 模块 
进行 选择 。 





图 8.4 X 轴 的 Simulink 控制 方 框图 


轴 的 几何 误差 校正 和 补偿 通过 S- 函 数 接口 与 控制 器 集成 。 计 算 机 x 和 计算 机 
y 可 通过 开关 交换 机 获得 这 些 功能 ， 如 图 8.3 所 示 。 通 过 DS4001 板 获 得 所 有 三 
轴 限 位 开关 信号 。 这 些 限 位 开关 信号 作为 三 个 开关 的 控制 输入 ， 如 图 8. 3 所 示 。 
限 位 开关 被 激活 后 将 使 该 系统 的 控制 信号 无 效 。 整 个 Simulink 控制 框图 还 提供 了 
操作 员 紧 急 停止 功能 。 

为 了 几何 误差 的 补偿 ， 写 人 一 个 基于 MATLAB/Simulink 运行 的 软件 组 件 。 
使 用 这 种 软件 ， 包 括 基于 误 善 补偿 径 向 基 函 数 (RBF) 的 S- 函 数 可 自动 生成 ， 
假设 有 校准 试验 得 到 的 原始 数据 集 和 RBF 训练 要 求 的 简单 用 户 输入 。 因 此 ， 操 
作者 应 该 具备 一 点 RBF 的 技术 知识 。 

从 Simulink 控制 框图 生成 的 自动 代码 成 功 后 ， 控 制 器 将 运行 于 设置 的 
dSPACE 的 硬件 体系 结构 中 。 设 计 使 用 dSPACE 的 CONTROLDESK 用 户 界 面 允 许 
友好 用 户 操作 时 进行 参数 调整 、 改 变 和 数据 记录 。 控 制 参数 可 以 在 线 更 改 ， 同 时 
沿 着 所 有 轴 向 的 运动 都 可 以 从 显示 屏 上 看 到 。 
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8.4.3 MARE 


用 户 界 面 设 计 成 基于 dSPACE CONTROLDESK 仪器 工具 的 一 个 虚拟 仪器 面 
板 。CONTROLDESK 是 一 个 全 面 的 设计 环境 ， 设 计 人 员 可 以 直观 地 管理 使 用 仪 
表 ， 并 自动 进行 他 们 的 试验 和 操作 。CONTROLDESK 无 缝 集 成 在 dSPACE 的 开发 
平台 中 。 它 可 以 实现 实时 数据 采集 、 在 线 参数 化 ， 并 提供 所 有 模型 变量 的 快捷 访 
问 而 不 必 中 断 运行 操作 。 整 个 用 户 界 面 设计 可 以 简单 通过 仪器 选择 和 拖 放 操作 实 
现 。 这 大 大 加 快 了 设计 过 程 ， 并 帮助 避免 陷入 与 标准 设计 相关 的 在 线 编程 。 

图 8.5 所 示 为 定制 的 龙门 运动 系统 的 用 户 界面 。 该 接口 可 大 致 分 为 六 部 分 : 
运行 状态 、 控 制 按钮 、 参 数 调整 、 限 位 开关 、 参 考 信 号 和 结果 。 





图 8.5 定制 的 龙门 运动 系统 的 用 户 界面 
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界面 的 操作 状态 Operating Status 部 分 反映 系统 目前 的 运行 状态 。 提 供 一 个 紧 
急 停车 按钮 EMStop 在 紧急 情况 下 进行 中 断 系 统 操作 。 该 系统 的 状态 显示 在 按钮 
旁 的 LED 上 。 界 面 的 限 位 开关 Limit Switches 可 以 部 分 反映 限 位 开关 状态 ， 限 位 
开关 已 装 人 系统 ， 以 防止 系统 在 允许 范围 外 运行 。 界 面 的 控制 按钮 Control Button 
部 分 可 对 单个 轴 的 控制 器 进行 设置 。 多 态 LED 用 来 表示 当前 的 控制 器 应 用 。 控 
制 器 的 参数 ， 如 控制 增益 ， 可 以 在 参数 调整 Parameter Adjustments 区 在 线 调整 ， 
而 同时 在 结果 Results 区 可 以 看 得 到 控制 效果 。 具 体 的 运动 轨迹 在 参考 信号 Refer- 
ence Signal 区 设置 。 除 了 提供 用 于 演示 目的 的 标准 信号 外 ， 其 他 的 参考 信号 也 可 
以 相应 地 增加 ， 这 取决 于 具体 应 用 的 需要 。 


8.5 精度 测量 


一 台 机 器 的 精度 通常 按 规 定 程序 测量 。 对 相关 的 机 器 进行 一 些 假 设 ， 首 先 可 
以 对 可 获得 的 精度 进行 粗略 的 评估 。 做 以 下 假设 : 
假设 8.1 重复 性 误差 为 零 。 
假设 8.2 机 器 在 分 辨 率 可 分 辨 的 点 进行 校准 。 
考虑 一 个 FXYZ 类 型 (Hocken 1980 年 ) 的 三 维 机 器 ， 其 中 下 代表 机 架 ，X， 
Y, Z 代表 轴 的 堆 秋 顺序 轴线 (从 左 到 右 顺 序 是 工件 到 刀具 )。 关 于 工件 架 的 实 
际 位 移 *，y，z 部 分 可 写 为 
Ax =5.(x) +8,(y) +6,(z) -ya,, -On —ye,(%) + 
zle, (x) +6,(y)] -y [e (x) te,(y) +e,(z)] + 
zle, (x) +e,(y) +e,(z)] +x, 
Ay =8, (x) +8, (y) +8, (z) 一 za 一 
z[e, (x) +e,(y)] +x, [e (x) +te,(y) +e,(z)] - 
zle, (x) +e,(y) +e,(z)] +y, 
Az =6,(%) +8, (y) +6,(z) +ye, (x) - 
x le, (x) +e, (y) +e, (2)] +y, [e (x) +es(y) +e,(z)] +z, 
KH, x, y, z 是 机 架 位 置 的 标 称 值 ，x,，y,，z, 是 该 工具 尖 的 x，y，z 偏 移 ; 6, 
(w) 是 在 v 运 动 下 4 方向 的 位 移 误差 (该 误差 的 符号 选 刀 方向 ) ，e,(v) 是 关于 vw 
运动 下 wu 轴 的 旋转 。u Mo BERRE, TUE, YR ays Qus Op DINANE 
xy，xz， 和 平面 的 正 交 误差 。 
假设 1 x1 <400, | yl <250, | z1 50。 利 用 激光 干涉 测量 系统 ， 可 测 
量 线性 和 直线 度 准 确 误 差分 辩 率 可 高 达 1nm， 可 测量 角度 (俯仰 ， 偏 航 ) mE 
直 度 误差 分 辨 率 精 确 到 0. 002arcsec。 滚 动 误 差 不 能 用 激光 干涉 仪 直接 测量 。 可 
使 用 的 电子 水 平 传感器 精确 度 只 有 0.2arcsec。 不 过 ， 它 可 以 进行 插值 达到 
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0. 002arcsec。 根 据 假设 8. 1 和 8.2， 通 过 整个 工作 体积 误差 可 以 估计 ， 假 设 
x, =y, =z, =0 
[Axl <1 +1+1 +2.5 x10 x9. 76 x10~° +0.5 x10® x9. 76 x10? + 
2.5 x 10° x9. 76 x10™? +0. 5 x10°(9. 76 x10~° +9. 76 x10~°) 
=9. 34nm 
IAyl <1 +1+1 +0.5x10° x9. 76x10? + 
0.5 x 10°(9. 76 x 10~° +9.76 x10°°) =4.46nm 
|Azi <1 +1 +1 +2.5 x10° x9.76 x10? =5. 44nm 
对 角 线 绝对 误差 为 
|Ad| = Ax’ +A +A < 11. 69nm 
没有 滚动 测量 插值 ， 误 差 增加 到 
1Ax1 < 57.66nm 
lAyl < 52.78nm 
1Azl < 247. 00nm 
1Adl < 259.07nm 
如 果 直 线 可 重复 性 和 直线 度 误差 是 和 (单位 为 am) ， 角 误差 为 角 分 辩 率 以 上 
的 g 倍 ， 于 是 工作 体积 上 的 误差 为 
lAxl <3A +6.34p 
IAyl <3A +1. 469 
1Azl <3A +2. 449 
|Ad| < /27)? +48. 289” +61. 44A9 
ALFA A =2000nm 的 机 械 规 格 ，p =100 (ABR HED 0. 2arcsec), ， 因 此 
I Adi <10. 99 um 
MATRA, AAT RE RTRRERTH RR. 
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前 面 各 章 都 专门 集中 介绍 了 传感器 、 执 行 器 和 控制 平台 。 为 了 整合 这 些 元 
件 ， 作 为 一 个 系统 高 效率 地 工作 或 连接 多 个 控制 系统 ， 信 和 号 通信 协议 和 标准 是 必 
要 的 。 

现场 总 线 是 一 个 数字 化 的 、 双 向 的 串 行 总 线 通 信 网 络 ， 连 接 各 种 仪器 、 传 感 
器 、 控 制 器 、 最 终 控制 元 件 和 其 他 设备 。 它 是 分 布 式 实 时 系统 的 支柱 之 一 ， 并 大 
大 简化 了 现场 设备 之 间 的 接线 。 

本 节 将 介绍 典型 的 现场 总 线 协 议 栈 和 目前 在 伺服 驱动 器 中 使 用 的 公共 现场 
协议 。 
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8.6.1 现场 总 线 协议 栈 


开放 系统 互 连 (OS) 的 模型 定义 了 通信 系统 的 主要 内 容 。 该 模型 有 七 层 ， 
如 图 8.6 所 示 。 
源 与 目的 间 数 据 的 解释 
信息 表述 与 转换 
子 应 用 之 间 的 对 话 管理 
获得 可 靠 数 据 网 络 传输 的 方法 
跨越 复杂 网 络 通信 的 方法 


两 个 直接 链接 单元 的 协调 规则 
链接 与 信号 的 物理 特性 





图 8.6 OSI 模型 


这 个 0SI 模型 是 标准 化 的 参考 模型 。 它 不 定义 准确 的 服务 或 协议 ， 而 仅 是 界 
定 每 一 层 应 该 做 的 事 。 通 信和 功能 由 最 低 的 三 个 层 实施 ， 主 机 功能 由 上 面 四 层 实 
施 。 最 低 的 两 层 处 理 中 间 节 点 。 其 余 层 是 端 至 端的 服务 。 

OS] 模型 是 一 种 通用 的 通信 模式 。 现 场 总 线 协议 栈 通常 只 涉及 以 下 层次 : 

1) 物理 层 。 

2) 链 路 层 。 

3) 网 络 层 。 

4) 应 用 层 。 

应 用 层 以 上 可 能 会 有 一 个 用 户 层 ， 以 实现 高 一 级 用 户 功能 ， 或 这 些 功能 可 能 
是 作为 应 用 层 的 部 分 来 实现 。 

除非 是 更 复杂 系统 ， 其 余 的 层 并 不 重要 ， 原 因 如 下 : 

1) 对 实时 响应 的 解决 方案 ， 涉 及 穿越 全 部 七 层 的 协议 费用 是 不 可 接受 的 。 

2) 现场 通信 需求 并 不 密集 ， 典 型 的 是 小 至 中 等 规模 的 通信 ， 但 协议 的 费用 
要 低 。 

3) 这 一 级 的 通信 系统 必须 简单 ， 易 于 安装 和 维护 ， 并 且 成 本 应 低廉 。 

此 外 ， 链 路 层 和 网 络 层 通常 是 密切 联系 在 一 起 ， 该 网 络 的 组 成 部 分 就 相对 简 
单 。 一 些 技术 规范 往往 把 这 样 的 链 路 /网 络 层 组 合 处 理 为 初始 网 络 部 件 ， 只 作为 
一 个 链 路 层 使 用 。 

1. 物理 层 

在 这 一 层 ， 数 据 链 接 和 数据 信号 的 物理 性 质 得 以 定义 ， 即 定义 使 用 数据 链接 
的 类 型 、 物 理 拓 扑 结构 、 链 接 信号 的 性 质 (电压 、 电 流 和 频率 )、 信 令 速 率 、 数 
据 单元 〈 字 节 和 字 ) 、 逻 辑 转 换 的 信和 号 及 使 用 连接 器 的 类 型 。 
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拓扑 结构 的 例子 如 图 8.7 和 图 8.8 Bras. 


图 8.7 点 对 点 拓扑 


?TT?T?T? 


环形 


图 8.8 广播 拓扑 


2. 链 路 层 


链 路 层 定 义 了 通信 和 实体 ( 源 或 目的 ) 之 间 的 通信 规则 和 直接 连接 到 该 实体 
的 通信 系统 元 素 。 链 路 层 所 涉及 的 关键 要 素 包括 : 


1) 在 两 点 之 间 建 立 的 链接 。 

2) 媒体 访问 控制 ， 即 “话语 权 ” 
链接 。 

3) 链接 数据 和 链接 命令 的 隔离 。 

4) 错误 检测 与 校正 技术 。 

5) 链 路 故障 和 恢复 方法 的 指示 。 


(流量 控制 ) 规则 ， 是 半 双 工 或 全 双 工 


媒体 访问 控制 可 能 会 集中 在 流行 的 算法 ， 如 主 从 、 令 牌 总 线 或 载波 侦 听 多 路 


访问 /冲突 检测 (CSMA / CD), 


除了 媒体 访问 控制 ， 错 误 检 测 和 校正 是 链 路 层 必 须 能 够 执行 两 个 重要 特性 ， 
因为 错误 是 一 直 存 在 的 ， 并 且 在 每 一 个 系统 发 生 。 错 误 可 能 是 小 的 〈 仅 1 位 相 
反 ) ， 可 能 是 大 的 〈 全 命令 或 响应 的 损失 ) 。 


错误 检测 可 以 在 以 下 几 个 层次 组 织 : 
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1) 字 节 的 层次 ， 这 是 一 个 校 验 位 。 

2) 数据 包 的 层次 ， 这 是 一 个 校 验 字 节 或 校 验 字 节 数 。 

如 果 整 个 消息 丢失 ， 只 有 一 个 方法 来 恢复 ， 就 是 再 次 发 送 。 自 恢复 协议 是 有 
风险 的 ， 通 常 不 可 靠 。 

3. 网 络 层 

网 络 层 定义 了 端 到 端的 通信 规则 。 它 提供 网 络 寻 址 和 数据 路 由 的 方法 。 

为 了 提供 有 序 的 通信 ， 网 络 中 的 所 有 元 素 都 必须 分 配 地 址 。 寻 址 是 一 个 要 考 
虑 的 重要 问题 ， 原 因 如 下 

1) 必须 有 足够 的 地 址 空间 。 如 果 8 位 分 配 ， 网 络 不 能 超过 256 个 成 员 。 如 
果 使 用 太 多 不 必要 的 位 ， 网 络 性 能 会 下 降 。 

2) 必须 设置 从 传感器 到 控制 器 的 所 有 网 络 组 件 的 地 址 。 

3) 地 址 必须 是 唯一 的 。 

实际 上 ， 所 有 的 现场 总 线 允 许 这 样 的 消息 ， 它 们 不 是 针对 任何 特定 的 设备 ， 
而 是 针对 所 有 的 设备 。 这 样 的 消息 被 称 为 广播 信息 。 

4. 应 用 层 

应 用 层 定义 了 被 传输 和 被 接收 数据 的 含义 。 它 是 需要 网 络 服务 的 应 用 访问 
层 。 这 一 层 将 提供 文件 、 打 印 、 邮 件 和 应 用 数据 库 服 务 。 应 用 户 的 请 求 确定 并 开 
始 必 要 的 服务 。 在 这 个 层面 上 控制 系统 的 应 用 中 ， 各 种 命令 代码 是 以 响应 代码 和 
数据 的 格式 定义 。 这 一 层 提 供 各 种 控制 功能 服务 。 

5. HAR 

可 能 会 有 一 个 用 户 层 ， 目 的 是 在 更 有 效率 地 实施 高 层次 的 控制 功能 。 它 连接 
单个 设备 域 ， 并 提供 一 个 高 层 应 用 环境 。 目 前 功能 块 通常 被 用 于 在 这 一 层 实 现 控 
制 策略 。 每 个 现场 总 线 设备 有 一 个 设备 描述 (DD) 。 该 设备 描述 (DD) 可 以 看 
做 是 特定 设备 的 驱动 程序 。 它 包括 所 有 使 用 该 设备 的 变量 描述 和 相应 的 作业 程 
序 ， 从 而 使 DD 真正 做 到 互 可 操作 。 一 旦 任何 控制 系统 或 主机 具有 该 设备 的 DD， 
它 就 能 够 与 该 设备 通信 。 

6. 遍历 堆栈 

当 传 输 设备 发 送 一 个 消息 (PDA 的 分 组 数据 单元 ) 时 ， 消 息 将 穿越 层次 向 
下 至 物理 层 的 物理 介质 层 ， 随 后 穿越 层次 向 上 至 接收 装置 。 当 出 现 一 个 消息 请 求 
时 ， 接 收 设备 将 以 逆转 的 方式 接收 和 响应 。 向 下 遍历 堆栈 期 间 ， 来 自传 送 设备 的 
原始 信息 被 每 一 层 增加 了 信息 段 ， 增 加 的 信息 在 接收 设备 的 相应 层 又 被 去 掉 。 


8.6.2 常见 的 现场 总 线 


对 现场 设备 的 选择 出 于 配套 的 协议 ， 反 之 亦 然 。 一 个 特定 制造 商 制造 的 设备 
通常 符合 特定 的 协议 ， 所 以 通常 无 法 真正 分 别 选 择 协 议和 使 用 的 支持 设备 。 本 节 
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将 介绍 一 些 常见 的 具有 更 为 广泛 的 用 户 基 础 的 现场 总 线 。 

1. CANopen 

控制 器 区 域 网 络 (CAN) 是 一 种 微 控 制 器 的 串 行 总 线 网 络 ， 连 接 一 个 系统 
或 子 系统 的 器 件 ， 如 传感器 和 执行 器 以 达到 实时 控制 应 用 。CAN 提供 许多 强大 
的 特性 ， 包 括 多 主机 功能 和 广播 或 组 播 电报 的 能 力 。CAN 总 线 还 具备 了 许多 其 
他 优点 ， 其 中 包括 成 本 低廉 、 数 据 可 靠 性 高 、 响 应 时 间 短 ， 还 有 一 个 巨大 的 用 户 
群 。 这 些 优点 使 CAN 跨 入 现场 总 线 技术 领先 行列 ， 特 别 是 在 汽车 和 纺织 工业 
领域 。 

在 CANopen 协议 中 使 用 该 网 络 独 特 的 标识 符 把 消息 广播 到 网 络 中 的 所 有 节 
点 。 基 于 此 标识 符 ， 单 个 节点 决定 是 否 处 理 该 消息 ， 同 时 根据 对 总 线 访 问 的 竞争 
条 件 确定 了 该 消息 的 优先 权 。 这 种 方法 当 检 测 到 冲突 时 ， 人 允许 传输 不 间断 ， 不 像 
以 太 网 ， 检 测 到 冲突 时 将 停止 传输 。 

CANopen 通信 和 是 一 种 基于 CAN 的 高 层 协议 。 这 是 作为 一 个 标准 化 的 艇 人 式 
网 络 和 面向 运动 机 器 控制 的 网 络 ， 现 在 还 用 于 许多 其 他 领域 ， 如 医疗 设备 、 越 野 
车 辆 、 海 运 电子 、 公 共 交 通 和 楼 宇 自动 化 等 。 

CANopen 提供 了 这 样 一 种 机 制 ， 使 不 同类 型 的 设备 可 以 得 以 整合 ， 并 能 够 进 
行 标准 化 方式 的 通信 。 通 过 利用 设备 的 配置 文件 信息 ，CANopen 设备 将 确保 其 共 
同 的 操作 功能 。 例 如 ， 从 两 个 制造 商 分 别 生 产 的 两 个 不 同 的 数字 模块 会 有 共同 的 
功能 ， 如 设置 输出 和 阅读 输入 。 该 协议 指定 的 共同 功能 必须 能 让 设备 进行 互 操 
作 。 有 了 CANopen， 制 造 商 在 其 设备 中 对 各 种 功能 都 不 限制 。 

CANopen 设备 配置 文件 的 基本 组 成 部 分 是 对 象 词典 ， 其 中 包括 一 个 数据 对 
象 、 通 信 对 象 和 命令 /动作 的 混合 。CANopen 通信 服务 让 用 户 完全 访问 对 象 词典 ， 
允许 阅读 和 写 数据 和 命令 。 数 据 和 命令 实施 使 用 16 位 索引 寻 址 机 制 与 8 位 细 分 
索引 ， 给 出 一 个 范围 为 0000H 到 FFFFH 的 地 址 。 部 分 对 象 词典 基于 功能 分 为 不 
同 的 领域 。 例 如 ， 索 引 6000H 是 保留 给 读 的 地 址 。 

CANopen 通信 提供 开放 的 协议 ， 并 允许 在 没有 总 线 主 控 单 元 的 参与 下 ， 网 络 
节点 之 间 进 行 直 接 的 数据 交换 。 它 允许 充分 的 广播 /组 播 特性 和 多 种 通信 方式 ， 
旨 在 使 总 线 负载 最 小 并 可 预测 。 因 此 ，CANopen 通信 非常 适合 远程 智能 的 概念 ， 
是 理想 的 分 布 式 控制 解决 方案 。 

2. Profibus 

Profibus 现场 总 线 是 开放 的 数字 通信 系统 ， 主 要 用 于 工厂 自动 化 。 现 在 它 在 
数据 通信 市 场 上 居 领 先 地 位 ， 占 通信 市 场 20% HMR, AA 2000 种 产品 应 用 了 
Profibus, Profibus 目前 广泛 应 用 于 食品 和 制药 行业 。 

Profibus 现场 总 线 协议 的 结构 包括 三 个 层次 : 物理 层 〈 第 一 层 ) 、 数 据 链 路 
层 〈 第 二 层 ) AMAR (第 七 层 )。 


> 192- 精密 运动 控制 : 设计 与 实现 





物理 层 介 绍 了 在 屏蔽 双 绞 线 对 中 使 用 的 标准 的 串 行 通信 EIA 一 485 ， 使 用 中 
继 器 和 数字 传输 NRZ 码 来 扩展 总 线 拓扑 树 。 

数据 链 路 层 定 义 了 网 络 节点 的 逻辑 模型 。 该 网 络 节点 包含 从 站 (只 有 在 主 
站 的 要 求 下 使 用 网 络 传输 介质 ) 和 主 站 ( 主 站 可 与 主 站 及 从 站 之 间 相 互通 信 )。 
在 主 站 中 ,介质 访问 遵循 令 牌 传递 的 规则 ， 即 定义 的 位 序列 ， 允 许 设备 之 间 的 相 
互通 信和 使 用 局 域 网 。 主 站 连接 逻辑 环保 证 确定 的 传输 时 间 ， 不 与 总 线 电 缆 内 其 
他 数据 冲突 ， 因 为 只 有 有 令 牌 的 站 可 以 传输 数据 ， 而 其 他 站 则 禁止 传播 数据 。 从 
站 的 介质 访问 控制 遵循 主 从 方式 ， 这 里 的 主 站 是 主动 站 。 数 据 链 路 层 再 划分 为 两 
个 子 层 ， 一 个 子 层 是 介质 访问 控制 层 ， 另 一 个 子 层 为 更 高 层 的 接口 提供 同步 / 蜡 
步 传输 服务 。 

应 用 层 允 许 对 象 操 作 ， 使 用 对 象 可 以 是 变量 、 阵 列 、 和 矩阵 、 变 量 列表 、 程 序 
调用 和 子 程序 等 。 这 分 为 两 个 子 层 : FMS (现场 总 线 信 息 规范 ) ALL (低层 接 
口 )。 

Profibus 现场 总 线 互 联 驱 动 和 操纵 装置 可 能 通过 局 域 网 来 实现 控制 回路 。 例 
如 ， 在 电 驱 动 的 操作 中 ， 主 站 处 理 路 径 生 成 和 位 置 环 ， 从 站 处 理 速度 和 力矩 环 。 

3. 基金 会 现场 总 线 

基金 会 现场 总 线 (FF) 是 一 种 串 行 的 双向 通信 系统 ， 是 工厂 自动 化 的 基础 
层次 网 络 ，FF 同 以 太 网 连接 ， 实 现 典 型 的 硬件 平台 。 定 义 了 两 个 层次 的 网 络 ， 
H1 和 HSE, 分 别 确定 31. 25 kbit/s 和 100 Mbit/s 的 传输 速率 。 

FF 的 关键 概念 是 一 个 调度 时 间 表 ， 可 以 确保 所 有 信息 在 规定 的 时 间 内 被 转 
移 到 正确 的 目的 地 节点 。 这 使 FF 具有 及 时 获取 信息 的 能 力 。 该 调度 时 间 表 作为 
管理 者 控制 信息 流量 ， 它 决定 何 时 发 送 一 个 消息 ， 发 送 什么 信息 ， 应 该 被 发 送 到 
何 地 等 。 调 度 时 间 表 在 本 质 上 是 信息 执行 的 算法 ， 并 且 算 法 的 内 容 可 以 各 自 不 
同 。 但 是 ,通常 信息 包括 周期 数据 (同步) 和 用 户 的 请 求 (异步 )， 并 要 求 从 设 
备 ( 异 步 )。 所 有 消息 都 传送 到 总 线 ， 由 于 要 转送 多 个 消息 , 令 牌 机 制 用 于 确定 
哪些 应 该 传送 ,优先 考虑 同步 消息 

FF 的 结构 和 特性 使 得 它 适合 用 于 诊断 ， 例如 ， 液 压 应 用 的 阀门 诊断 ， 这 和 需 
要 及 时 获取 信息 。 在 此 应 用 中 ， 过 程 信息 如 压力 、 温 度 和 水 位 得 到 监测 。 此 信息 
然后 经 统计 工具 处 理 ， 可 以 与 一 个 阐 值 比较 ,使 这 一 过 程 的 状态 可 以 被 诊断 。 例 
如 ， 温 度 的 统计 分 布 有 一 个 指数 上 升 可 能 表明 该 系统 有 过 热 的 迹象 。 

4. Firewire 

Firewire (也 称 为 使 用 i Link 或 IEEE 1394) 是 个 人 计算 机 及 数字 视频 接口 
标准 的 串 行 总 线 ， 提 供 高 速 通信 和 实时 数据 服务 。Firewire 是 对 SCSI 并 行 接口 的 
继承 。 它 是 由 苹果 电脑 公司 开发 的 ， 并 已 广泛 应 用 于 计算 机 和 消费 电子 行业 。 

Firewire 的 优点 如 下 : 
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1) 这 是 一 个 低 成 本 、 自 供电 、 高 速 的 数码 单线 缆 串 行 总 线 ， 适 合 实时 运动 
控制 应 用 。 

2) 带宽 可 总 体 确定 的 。 

3) 兼容 点 对 点 通信 。 

4) 速度 范围 从 100 至 400 Mbit/s, 

5) 总 线 支持 挂 接 63 个 设备 。 

6) 高 达 10m 的 电缆 长 度 的 中 继 器 ， 可 用 于 扩展 距离 。 

7) 兼容 数字 即 插 即 用 设置 ， 所 有 参数 软件 驱动 。 

8) 接口 通常 包含 在 所 有 的 个 人 计算 机 中 ， 可 以 方便 地 进行 设置 和 配置 。 

Firewire 的 缺点 如 下 : 

1) 没有 标准 的 协议 。 

2) Firewire 只 解决 开发 行业 标准 的 一 小 部 分 实际 问题 。 

5. Sercos 

串 行 实时 通信 系统 (Sercos 总 线 ) 接口 是 一 个 数字 运动 控制 总 线 ， 可 以 与 运 
动 控制 、 驱 动 器 、LO 端口 和 传感器 互 连 。 这 是 一 开放 式 控制 器 数字 驱动 器 接 
口 ， 设 计 用 于 通过 抗 噪 纤维 光缆 实现 实时 闭环 数据 的 高 速 串 行 通信 。 利 用 Sercos 
数字 驱动 的 功能 ,不仅 能 替代 标准 的 10V 模拟 标准 接口 ， 而 且 提供 控制 和 驱动 
之 间 的 双向 通信 。 

控制 和 驱动 器 使 用 标准 的 传输 介质 、 拓 扑 、 连 接 技术 、 信 号 电 平 、 消 息 结 
构 、 时 序 和 数据 格式 。 这 使 得 来 自 不 同 于 Sercos 厂商 的 设备 可 以 在 同一 平台 上 进 
行 双向 通信 。 

Sercos 总 线 的 优点 如 下 : 

1) 控制 和 驱动 器 之 间 通 过 光纤 环 交换 数据 ， 可 消除 电磁 干扰 。 

2) 发 送 命令 和 实际 值 所 用 时 间 很 得 ， 保 证 与 轴 的 精确 同步 。 

3) 它 支持 四 个 操作 模式 ， 包 括 转 矩 模式 、 速 度 模式 、 位 置 控制 模式 和 块 
模式 。 

4) Sercos 机 器 即 插 即 用 ， 易 于 适应 不 同 的 应 用 。 

5) Sercos 的 实施 提高 了 系统 的 灵活 性 ， 一 个 完全 相同 的 驱动 可 参数 化 处 理 
多 个 主要 对 象 。 

6) 来 自 不 同 销售 商 的 Sercos 接口 产品 可 以 互相 操作 。 

7) 主机 控制 每 个 环 ， 分 配 时 隙 以 确保 适当 地 传输 数据 。 

Sercos 总 线 的 缺点 如 下 : 

1) Sercos 接口 的 速度 不 佳 。 高 于 要 求 4 ~ 10 倍 的 传输 数据 速度 也 不 能 大 幅 
提高 整 机 性 能 。 

2) 该 接口 有 32-767 个 标准 命令 的 识别 号 码 ， 同 时 也 有 能 力 纳入 32-767 R 
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别 号 码 。 有 时 Sercos 接口 与 其 他 接口 不 兼容 。 

3) Sercos 接口 的 成 本 可 能 会 比 其 他 标准 高 。 

6. 以 太 网 

以 太 网 具有 布局 的 灵活 性 和 能 与 大 多 数 的 办 公 网 络 的 互 操作 的 特性 ， 最 初 主 
要 用 于 办 公 自 动 化 的 用 途 。 以 太 网 的 发 展 带 来 了 目前 100 Mbit/s 的 通信 技术 ， 使 
其 可 以 作为 一 种 工业 网 络 的 主流 应 用 。 

以 太 网 (Ethernet) 是 局 域 网 (LAN) 的 计算 机 网 络 技术 。 这 个 词 本 身 来 自 
于 “ether”， 科 学 家 过 去 认为 “ether” 是 外 太空 中 的 媒介 。 其 实 ， 以太 网 是 网 络 
内 各 种 设备 通信 的 硬件 介质 。 以 太 网 定义 了 物理 层 和 数据 链 路 层 的 连接 。 图 8.9 
所 示 为 以 太 网 的 分 类 。 

以 太 网 


Hi H2 HSE 
能 够 连接 至 | 
MERES 多 127 个 设备 速度 10Mbit/s 
速度 i .25kbit/s 速度 1] 一 2 能 够 接续 H1( 现 场 级 ) 
使 用 
一 条 电缆 可 同时 可 为 VO 子 系统 、 控 制 
传送 数据 和 电源 器 和 复杂 设备 应 用 


图 8.9 以 太 网 的 分 类 


随 着 以 太 网 的 建立 ,不 同 的 协议 的 设备 (但 同样 以 以 太 网 为 平台 ) 可 以 存 
在 于 同一 个 局 域 网 而 不 发 生 冲 突 ， 虽 然 由 于 协议 不 同 没有 通信 建立 。 这 简化 了 网 
络 的 电力 装置 。 此 外 ， 以 太 网 寻 址 方案 进一步 消除 了 设备 之 间 冲 突 的 可 能 性 。 

以 太 网 的 拓扑 结构 遵循 物理 层 拓 扑 。 由 于 电缆 的 物理 信号 衰减 限制 了 网 络 的 
长 度 。 在 这 种 情况 下 ， 必 须 使 用 集线器 和 中 继 器 。 它 们 的 作用 主要 是 刷新 信号 ， 
以 便 信号 可 以 远 距 离 传 输 。 但 是 ， 数 据 传 输 速 度 仍 会 限制 集线器 和 中 继 器 的 数 
量 。 例 如 ， 以 10 Mbit/s 的 速度 ， 两 个 节点 之 间 和 集线器 和 中 继 器 的 数量 不 得 超过 
4 个。 集线器 和 接收 器 广播 信息 到 所 有 端口 ， 让 每 个 端口 只 得 到 一 部 分 可 用 
带宽 。- 

在 一 个 工业 网 络 中 ， 它 很 可 能 是 网 络 的 不 断 扩 大 ， 整 个 网 络 好 像 由 系统 的 几 
个 地 方 网 络 组 成 。 另 一 个 类 似 的 情况 是 几 个 小 网 络 的 合并 ， 用 自己 的 基于 以 太 网 
的 网 络 ， 要 形成 一 个 高 性 能 系统 。 以 太 网 桥 可 以 完成 多 个 网 络 之 间 的 连接 ， 即 使 
每 个 网 络 可 能 工作 的 速度 不 同 。 以 太 网 桥 有 能力 使 用 以 太 网 解决 方案 ， 直 接 使 信 
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息 发 到 目的 接收 者 。 这 是 以 太 网 桥 和 集线器 之 间 的 区 别 ， 集 线 器 不 会 过 滤 信息 。 

设备 通过 网 络 接口 卡 (NIC) 连接 到 以 太 网 。 网 络 接口 卡 能 自动 选择 应 该 工 
作 的 正确 速度 。 以 太 网 从 原来 办 公 室 水 平 自动 化 的 标准 ， 和 逐渐 渗 透 进入 到 工业 控 
制 环境 。 以 工业 以 太 网 为 骨干 ， 诊 断 功 能 可 以 很 容易 扩大 到 整个 网 络 范围 内 ， 提 
供 诊断 服务 功能 ， 并 且 是 一 个 位 置 独立 的 基础 设施 。 尽 管 以 太 网 大 力 发 展 ， 以 太 
网 的 未 来 仍然 充满 挑战 。 数 据 采集 就 是 需要 应 对 的 挑战 之 一 。 如 果 工 厂 数 据 可 以 
从 现场 设备 及 本 地 控制 器 直接 提取 ， 将 是 以 太 网 巨大 的 优势 。 这 需要 控制 器 巨大 
的 内 存 。 现 在 在 以 太 网 技术 的 发 展 中 开始 采用 光纤 和 无 线 通信 技术 。 

无 线 以 太 网 通常 采用 红外 线 或 无 线 电 频 率 通信 ， 可 用 于 两 个 点 对 点 通信 和 基 
础 设施 通信 。 虽 然 无 线 以 太 网 提供 了 极 大 的 灵活 性 ， 但 是 因为 无 法 进行 远 距 离 
( 约 100 ~200m) 传输 信息 ， 其 效率 大 大 降低 。 此 外 ， 无 线 以 太 网 更 容易 发 生 信 
息 冲 突 ， 因 为 某 些 节点 由 于 物理 阻塞 可 能 无 法 辨认 另 一 路 传输 (与 以 太 网 的 个 
案 不 同 ) 。 解 决 这 个 问题 通常 是 由 虚拟 检查 ， 即 转 递 节点 发 送 一 个 请 求 到 所 有 节 
点 ， 并 等 待 允 许 直 到 发 送 消息 。 然 而 ， 这 仍然 是 一 个 需要 进行 不 断 研究 和 改进 的 
领域 。 

无 线 以 太 网 可 以 显著 提高 运动 控制 系统 的 性 能 ， 因 为 它 可 以 到 达 由 电缆 无 法 
到 达 的 网 络 部 分 ， 例 如 环境 的 化 学 条 件 不 允许 电缆 /电线 在 网 络 使 用 的 时 候 。 


附录 。 激光 校准 光学 仪器 、 附 件 和 配置 


1 一 两 个 位 置 和 高 度 调节 器 
2 一 线性 干涉 仪 1 
3 一 附件 螺钉 

4 一 两 个 线性 反射 镜 
5 一 基 座 








图 A.1 线性 测量 的 光学 仪器 与 附件 


1 一 两 个 位 置 和 高 度 调节 器 。 
2 一 角 反 射 镜 
3 一 角 干 涉 仪 
4 一 两 个 校准 器 
5 一 基 座 











图 A.2 角度 测量 的 光学 仪器 与 附件 


附录 ”激光 校准 光学 仪器 、 附 件 和 配置 





1 一 安装 在 柱 和 基 应 高 度 
调节 器 上 的 角 反 射 器 


2 一 安装 在 轴 上 的 角 干 涉 仪 
3 一 激光 束 













4 一 激光 头 
5 一 安装 在 轴 上 的 角 反射 器 
6 一 安装 在 柱 和 基 座高 度 
调节 器 上 的 角 干 涉 仪 
F BZ 轴 测 量 , 具有 激光 束 折 
射 90 到 光学 部 件 
图 A.3 俯仰 测量 的 配置 
1 一 安装 在 柱 和 基 座 高 度 
调节 器 上 的 角 反射 器 


2 一 安装 在 轴 上 的 角 干 涉 仪 
3 一 激光 束 

4 一 激光 头 

5 一 安装 在 柱 和 基 座 高 度 
调节 器 上 的 角 干 涉 仪 


6 一 安装 在 轴 上 的 角 反射 器 


b) 沿 7 轴 测 量 
图 A. 4 偏 航 测量 的 配置 
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c) 沿 Z 轴 测量 ,具有 激光 束 
折射 垂直 90* 到 反射 器 


图 A.4 偏 航 测量 的 配置 〈( 续 ) 


直线 度 测 量 附件 工具 包 
1 一 反射 器 安装 

2 一 反光 镜 

3 一 干涉 仪 基 座 盘 

4 一 反射 器 基 座 和 柱 


长 距 光 学 部 件 包 
5 一 长 距 反 射 器 
6 一 长 距 干涉 仪 


短 距 光 学 部 件 包 
7 一 短 距 反 射 器 
8 一 短 距 干涉 仪 
9 一 干涉 仪 目标 
10 一 高 度 调节 器 和 柱 


旋转 镜 包 
11 一 旋转 镜 
12 一 旋转 镜 基 座 


图 A.6 















直线 度 测量 附件 工具 包 
1 一 反射 器 安装 l 
2 一 反光 镜 

3 一 干涉 仪 基 座 盘 
4 一 反射 器 基 座 和 柱 


长 距 光 学 部 件 包 
5 一 长 距 反 射 器 
6 一 长 距 干 涉 仪 


短 距 光 学 部 件 包 
7 一 短 距 反 射 器 12 
8 一 短 距 干涉 仪 “| 
9 一 干涉 仪 目标 

10 一 高 度 调节 器 和 柱 
旋转 镜 包 10 


11 一 旋转 镜 
12 一 旋转 镜 基 座 





SR 
KAS 直线 度 测量 的 光学 仪器 与 附件 





XX 轴 与 Y 轴 的 直线 度 测量 配置 


附录 ”激光 校准 光学 仪器 、 附 件 和 配置 





光学 垂直 测量 包 
1 一 光学 部 件 垂 直 测量 基 座 
2 一 光学 垂直 测量 部 件 


直线 度 测 量 附 件 工具 包 
5 一 干涉 仪 基 座 盘 

6 一 反射 器 基 座 和 柱 
长 距 光学 部 件 包 


7 一 长 距 反射 器 
8 一 长 距 干 涉 仪 





短 距 光 学 部 件 包 
9 一 短 距 反射 器 
10 一 短 距 干 涉 仪 
11 一 干涉 仪 目标 
12 一 高 度 调节 器 和 柱 
13 一 反射 器 目标 


图 A.7 (水 平面 ) 垂直 度 测量 的 光学 仪器 与 附件 


1 一 水 平定 向 反射 器 
2 一 水 平定 向 垂直 测量 光学 部 件 
3 一 柱 上 安装 的 干涉 仪 
4 一 激光 头 





图 A.8 垂直 度 测 量 一 一 第 一 轴 (水 平面 ) 
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1 一 水 平定 向 反射 器 
2 一 柱 上 安装 干涉 仪 
3 一 激光 头 





AAS 垂直 度 测量 一 一 第 二 轴 (水 平面 ) 


光学 垂直 测量 包 
1 一 光学 部 件 垂直 测量 基 座 
2 一 光学 垂直 测量 部 件 


直线 度 测 量 附件 工具 包 
3 一 反射 器 安装 

4 一 直线 度 反光 镜 

5 一 反射 器 基 座 和 柱 


长 距 光 学 部 件 包 
6 一 长 距 反 射 器 
7 一 长 距 干 涉 仪 





短 距 光学 部 件 包 

8 一 短 距 反射 器 

9 一 短 距 干涉 仪器 
10 一 高 度 调节 器 与 柱 


旋转 镜 包 

11 一 旋转 镜 

12 一 旋转 镜 基 座 
13 一 反射 器 目标 





图 A.10 ” 《垂直 面 ) 垂直 度 测 量 的 光学 仪器 与 附件 
1 一 垂直 定向 反射 镜 
2 一 安装 在 柱 上 的 干涉 仪 
3 一 垂直 定向 的 光学 垂直 测量 部 件 
4 一 激光 头 
5 一 旋转 镜 





图 A.11 垂直 度 测量 一 一 第 二 轴 (垂直 面 ) 
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1 一 中 柱 

2 一 长 柱 

3 一 短 柱 

4 一 5mm 键 

5 一 4mm 键 

6 一 2.4mm 键 

7 一 正 角 夹 

8 一 光束 控制 配件 
9 一 调节 盘 
10 一 大 基 应 

11 一 柔性 球 教练 配件 
12 一 校准 目标 件 





1 一 HP 10766A 线 性 干涉 仪 1 
2 一 HP 10767A 线 性 反射 镜 
3 一 HP 10767B 轻 重量 反射 镜 





1 一 对 角 平 面 
2 一 2 轴 运 动 范围 
3 一 7 轴 运 动 范围 
4 一 x 击 运动 范围 
5 一 方位 角 (a) 
6 一 高 度 角 (BD 





图 A. 14 典型 对 角 线 测量 的 设置 
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